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DESCRIPTION 
CONTROL DEVICE OF LEGGED MOBILE ROBOT 

Technical Field 
5 The present invention relates to a gait generating 

device and a control device suited not only to walking but 
also to running of a legged mobile robot . 

Background Art 

10 Hitherto, a major object of generating gaits (desired 

gaits) for making a legged mobile robot, e.g., a bipedal 
mobile robot, carry out a traveling motion has been 
focused mainly on generating gaits (walking gaits) to make 
the robot effect a smooth walking motion. In recent years, 

15 however, as the development of legged mobile robots 

advances, it has come to be desired to generate gaits that 
enable the robots not only to walk but to run also. 
Furthermore, it has come to be desired to generate gaits 
that enable the robots to move without troubles even on a 

20 slippery floor (so-called low-fx path) on which a 
sufficient frictional force cannot be produced. 

Since the Chinese characters for "gait" include a 
character meaning "walking," the gait tends to be 
misinterpreted that the definition thereof is limited to 

25 walking. However, "gait" originally presents a concept 

that includes running, as it is used as a term indicating 
a running mode of a horse, such as "trot." 
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A description will now be given of the difference 
between walking and running in terms of characteristics. 

A traveling mode that includes an instant at which 
all legs are simultaneously floating is usually defined as 
5 running. This definition, however, does not always make 
it possible to clearly distinguish between walking and 
running. For instance, in most humans, there are instants 
at which all legs float at the same time during fast 
Jogging, whereas many humans have one of their legs always 
10 in contact with the ground during slow jogging. It is 

somehow perceptually unreasonable to define fast jogging 
as running and slow jogging as walking. 

Fig. 51 shows a pattern of vertical body positions 
and floor reaction force vertical components (a sum of 
15 floor reaction force vertical components acting on right 
and left legs) in typical running, and Fig. 52 shows a 
pattern of vertical body positions and floor reaction 
force vertical components in typical walking. 

A vertical body position/velocity means a vertical 
20 position of a representative point of a body and a 

velocity thereof. A horizontal body position/velocity 
means a horizontal position of a representative point of 
the body and a velocity thereof. A vertical body 
position/velocity and a horizontal body position/velocity 
25 together will be referred to as body position/velocity. 

Strictly speaking, the "floor reaction force vertical 
component" should be described as " trans lational floor 
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reaction force vertical component" to distinguish It from 
a moment component about a vertical axis of a floor 
reaction force; however, the term Is too long, so that the 
term "translatlonal" will be omitted • Hereinafter, the 
5 " trans latlonal floor reaction force horizontal component" 
will be described as "floor reaction force horizontal 
component," omitting "translatlonal. " 

First, attention will be focused on the movement of 
the body. In walking, the body reaches a highest level at 

10 the Instant the body passes over a supporting leg, while 
It reaches a lowest level at this Instant In running. In 
other words, the phase of a vertical motion pattern of the 
body reverses between walking and running. 

Meanwhile, a floor reaction force remains relatively 

15 constant In walking, whereas It considerably varies In 

running, the floor reaction force reaching Its maximum at 
the moment the body passes over a supporting leg. 
Needless to say, the floor reaction force is zero at the 
Instant when all legs are simultaneously floating. More 

20 detailed observation reveals that a floor reaction force 
of a magnitude that Is substantially proportional to a 
compression amount of the supporting leg is generated 
while running. In other words, it may be said that the 
legs are used like springs to jump for traveling while 

25 running. 

Slow jogging has the same body vertical motion phase 
as that of typical running. In addition, slow jogging 
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frequently includes no Instants at which all legs are 
simultaneously floating; however, even in this case, a 
floor reaction force reaches substantially zero, although 
not completely zero, at an instant when a supporting leg 
5 and an idle leg are switched. 

Hence, distinguishing between walking and running on 
the basis of the aforesaid characteristics of the vertical 
motions of the body or floor reaction force patterns as 
described above may be more appropriate and perceptually 
10 reasonable, because slow jogging is also regarded as 
running . 

In particular, to distinguish between the two on the 
basis of a most characteristic aspect, running may be 
defined as a traveling mode in which the floor reaction 

15 force becomes zero or substantially zero at the instant a 
supporting leg is switched, while walking may be defined 
as a traveling mode (a floor reaction force vertical 
component remaining relatively constant) other than that. 
The present applicant has previously proposed, in PCT 

20 Kokai publication WO/02/40224, an art for generating 

freely and in real time a gait of a legged mobile robot 
that includes a floor reaction force while substantially 
satisfying dynamic balance conditions (This means the 
conditions of balance among gravity, an inert ial force, 

25 and a floor reaction force of a desired gait. In a narrow 
sense, it means that the horizontal component of a moment 
about a desired ZMP by the resultant force of gravity and 
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an Inertlal force produced by a motion of a desired gait 
Is zero. Detailed description will be given hereinafter). 
This art and a series of the control devices of legged 
mobile robots proposed by the present applicant In 
5 Japanese Unexamined Patent Application Publication No. 10- 
86081, Japanese Unexamined Patent Application Publication 
No. 10-277969 can be applied to walking and also to 
running . 

These arts, however, have not considered the 

10 magnitudes of a translatlonal floor reaction force 

horizontal component of a desired gait or a vertical 
component of a floor reaction force moment about ZMP of a 
desired gait. Hence, there has been a danger in that a 
frlctlonal limitation is exceeded and the foot of a 

15 supporting leg of a robot slips occurs (a slip or a spin 
in a direction parallel to a floor surface). The term 
"spin" refers to a state in which a yaw angle (a 
rotational angle about a vertical axis) velocity of an 
actual robot deviates from a desired yaw angular velocity. 

20 When a robot walks on a floor surface having a high 

friction coefficient (in this case, at least one leg is 
always in contact with the ground) , a floor reaction force 
vertical component is always substantially equivalent to a 
robot's own weight, thus providing a higher limit of a 

25 frlctlonal force. This makes the robot resistant to slip. 

In running, however, there are cases where the floor 
reaction force vertical component becomes zero or close to 
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zero; hence. In such a case, the limit of the frlctlonal 
force of a floor surface becomes zero or close to zero 
even if a friction coefficient is high. Accordingly, 
there has been a danger in that a translational floor 
5 reaction force horizontal component or a floor reaction 

force moment vertical component of a desired gait exceeds 
a limit, causing a robot to spin and fall. 

Further, even in the case of walking, there has been 
a danger in that a robot slips and falls if a floor has a 

10 low friction coefficient. 

Meanwhile, the present applicant has previously 
proposed a technique, in which a desired gait is generated 
such that a translational floor reaction force horizontal 
component of the desired gait does not exceed a 

15 permissible range or an arm is swung so as to cancel a 

moment vertical component generated by anything other than 
arms in a desired gait in, for example, PCT application 
PCT/JP02/13596. According to this technique, the 
occurrence of slippage of a robot can be restrained. 

20 However, depending on the state or the like of a 

floor surface, the permissible range of a translational 
floor reaction force horizontal component may not match an 
actual limit of a frictional force of the floor surface. 
In such a case, there has been a possibility of the 

25 occurrence of a slippage of a robot. If the permissible 

range of the translational floor reaction force horizontal 
component is set to be narrower in order to avoid the 



slippage, then the posture (Inclination angle) of the body 
tends to significantly vary. Further, If the robot 
travels, severely swinging Its legs, then Its arms also 
severely swing to cancel a moment vertical component. 

Accordingly, an object of the present Invention Is to 
provide a control device which solves the problem 
described above and which Is capable of further securely 
preventing a robot from slipping and of generating a 
further Ideal gait regardless of gait types, such as 
walking and running, or a frlctlonal condition of a floor 
surface . 

Disclosure of Invention 

According to a first invention of a control device of 
a legged mobile robot in accordance with the present 
invention, 

there is provided a control device for generating a 
desired gait of a legged mobile robot that travels by 
moving a plurality of legs extended from its body and for 
controlling an operation of the robot so as to follow the 
desired gait, comprising: 

slippage determining means for determining an 
occurrence of a slippage of the robot in operation, 
following the desired gait; 

permissible range setting means for variably setting 
a permissible range of a restriction object amount 
according to a determination result of the slippage 



determining means, the restriction object amount being a 
horizontal component of a translatlonal floor reaction 
force to be applied to the robot, or a component of the 
translatlonal floor reaction force In parallel to a floor 
surface, or a horizontal component of a total center-of- 
gravity acceleration of the robot, or a component of the 
total center- of -gravity acceleration In parallel to a 
floor surface; 

provisional motion determining means for determining 
a provisional motion of the desired gait such that a 
resultant force of a gravity and an Inertlal force acting 
on the robot on a predetermined dynamic model satisfies a 
predetermined dynamic balance condition; and 

provisional motion correcting means for correcting 
the provisional motion to determine the motion of a 
desired gait by changing the changing rate of an angular 
momentum about the center of gravity of a robot from the 
provisional motion so as to limit the restriction object 
amount to the permissible range while satisfying the 
dynamic balance condition at the same time if the 
restriction object eunount defined by the provisional 
motion of the desired gait deviates from the permissible 
range . 

According to the first invention, if the restriction 
object amount (the horizontal component of a translatlonal 
floor reaction force, or the component of the 
translatlonal floor reaction force in parallel to a floor 



surface, or the horizontal component of a total center-of- 
gravity acceleration of the robot, or the component of the 
total center- of -gravity acceleration in parallel to a 
floor surface) that is defined by the provisional motion 
of a desired gait deviates from the permissible range, the 
provisional motion is corrected to determine the motion of 
a desired gait. In this case, the changing rate of the 
angular momentum about the center of gravity of the robot 
is changed from the provisional motion, thus allowing the 
restriction object amount to be limited to the permissible 
range while satisfying a dynamic balance condition (e.g., 
a condition in which the horizontal component of a floor 
reaction force moment about a desired ZMP becomes zero). 
The changing rate of an angular momentum to be changed may 
basically be set in a rolling direction or a pitching 
direction. In this case, the permissible range is 
variably set according to a determination result of the 
slippage determining means, so that a desired motion can 
be quickly corrected according to the occurrence of a 
slippage of an actual robot. As a result, if the actual 
robot slips, the motion of the robot is corrected so as to 
immediately restrain the slippage. Thus, according to the 
first invention, the occurrence of slippage of an actual 
robot can be restrained, making it possible to maintain 
the stability of the posture of the robot. If it is 
determined that a slippage has occurred, then the 
permissible range should be set to be narrower. This will 
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apply also to second to fourth inventions explained below. 

Next, according to a second invention of the legged 
mobile robot in accordance with the present invention, 

there is provided a control device for generating a 
5 desired gait of a legged mobile robot that travels by 

moving a plurality of legs extended from its body and for 
controlling an operation of the robot so as to follow the 
desired gait, comprising: 

slippage determining means for determining the 
10 occurrence of a slippage of the robot in operation, 
following the desired gait; 

permissible range setting means for variably setting 
a permissible range of a restriction object amount 
according to a determination result of the slippage 
15 determining means, the restriction object cunount being a 
vertical component of a floor reaction force moment to be 
applied to the robot or a component of the floor reaction 
force moment in the direction of a floor surface normal 
line or a vertical component of a changing rate of an 
20 angular momentum of the robot, or a component of the 

changing rate of the angular momentum in the direction of 
floor surface normal line; 

provisional motion determining means for determining 
a provisional motion of the desired gait such that a 
25 resultant force of a gravity and an inert ial force acting 
on the robot on a predetermined dynamic model satisfies a 
predetermined dynamic balance condition; and 
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provisional motion correcting means for correcting 
the provisional motion to determine the motion of a 
desired gait by changing the changing rate of an angular 
momentum of the robot from the provisional motion so as to 
5 limit the restriction object eunount to the permissible 
range while satisfying the dynamic balance condition at 
the same time if the restriction object amount defined by 
the provisional motion of the desired gait deviates from 
the permissible range. 

10 According to the second invention, if the restriction 

object amount (the vertical component of a floor reaction 
force moment or the component of the floor reaction force 
moment in the direction of a floor surface normal line or 
the vertical component of a changing rate of an angular 

15 momentum of the robot, or the component of the changing 
rate of the angular momentum in the direction of floor 
surface normal line) that is defined by the provisional 
motion of a desired gait deviates from the permissible 
range, the provisional motion is corrected to determine 

20 the motion of a desired gait. In this case, the changing 
rate of the angular momentum of the robot is changed from 
the provisional motion, thus allowing the restriction 
object conount to be limited to the permissible range while 
satisfying a dynamic balance condition (e.g., a condition 

25 in which the horizontal component of a floor reaction 
force moment about a desired ZMP becomes zero). The 
changing rate of an angular momentum to be changed may 
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basically be the changing rate of an angular momentum In a 
yaw direction. In this case, the permissible range Is 
variably set according to a determination result of the 
slippage determining means, so that a desired motion can 
be quickly corrected according to the occurrence of a 
slippage of an actual robot. As a result. If a slippage 
of the actual robot occurs, the motion of the robot Is 
corrected so as to Immediately restrain the slippage 
(especially a spin). Thus, according to the second 
Invention, the occurrence of slippage of an actual robot 
can be restrained, making It possible to maintain the 
stability of the posture of the robot. 

The first Invention and the second Invention may be 
combined. In this case, the horizontal component of a 
translatlonal floor reaction force, or the component of 
the translatlonal floor reaction force In parallel to a 
floor surface, or the horizontal component of a total 
center-of -gravity acceleration of the robot, or the 
component of the total center- of -gravity acceleration In 
parallel to a floor surface Is defined as one restriction 
object amount, and the vertical component of a floor 
reaction force moment or the component of the floor 
reaction force moment In the direction of a floor surface 
normal line or the vertical component of the changing rate 
of angular momentum of the robot, or the component of the 
changing rate of the angular momentum In the direction of 
floor surface normal line Is defined as the other 
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restriction object amount. The permissible ranges of 
these restriction object amounts may be variably set 
according to a determination result of the slippage 
determining means . In this case , it is preferable to 
5 correct a provisional motion of a desired motion if either 
one of the restriction object amounts deviates from its 
permissible range. 

Next, according to a third invention of a control 
device of a legged mobile robot in accordance with the 

10 present invention, 

there is provided a control device of a legged mobile 
robot adapted to sequentially determine an instantaneous 
value of a desired motion of a legged mobile robot, which 
travels by moving legs extended from its body, by using a 

15 dynamic model that expresses at least a relationship 

between a motion of the robot and a floor reaction force, 
and also to control an operation of the robot at the same 
time so as to make the robot follow the determined 
instantaneous value of the desired motion, comprising: 

20 slippage determining means for determining the 

occurrence of a slippage of the robot in operation, 
following the desired motion; 

permissible range setting means for variably setting 
a permissible range of a restriction object amount 

25 according to a determination result of the slippage 

determining means, the restriction object amount being at 
least a horizontal component of a translational floor 
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reaction force to be applied to the robot, or a component 
of the translatlonal floor reaction force in parallel to a 
floor surface, or a horizontal component of a total 
center- of -gravity acceleration of the robot, or a 
component of the total center -of -gravity acceleration in 
parallel to a floor surface; and 

desired instantaneous value determining means for 
determining, on the basis of at least the difference 
between a desired state amount of a posture of the robot 
that corresponds to the determined instantaneous value of 
the desired motion and an actual state amount of the 
posture of the robot, a new instantaneous value of the 
desired motion such that the restriction object amount 
determined on the basis of the dynamic model in 
correspondence to the new instantaneous value falls within 
the permissible range and the difference approximates zero. 

According to the third invention, a new instantaneous 
value of the desired motion is determined, on the basis of 
at least the difference regarding a state amount of a 
posture of the robot, such that the restriction object 
amount (a horizontal component of a translatlonal floor 
reaction force, or a component of the translatlonal floor 
reaction force in parallel to a floor surface, or a 
horizontal component of a total center -of -gravity 
acceleration of the robot, or a component of the total 
center -of -gravity acceleration in parallel to a floor 
surface) determined on the basis of the dynamic model in 
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correspondence to the new Instantaneous value falls within 
the permissible range and the difference approximates zero. 
This means that an instantaneous value of a desired motion 
is determined such that a restriction object amount will 
5 not deviate from a permissible range, while maintaining 

the posture of a robot at a desired posture (hereinafter, 
this condition may be referred to as "the 
posture/restriction object amount condition" in the 
explanation herein). And, in this case, the permissible 

10 range is variably set according to a determination result 
of the slippage determining means; therefore, an 
instantaneous value of a desired motion can be quickly 
determined so as to satisfy the posture/restriction object 
amount condition, depending on whether or not a slippage 

15 of an actual robot has occurred. As a result, even if a 
slippage of the actual robot occurs, the slippage can be 
immediately restrained, while stably maintaining the 
posture of the robot at a proper posture. 

According to a fourth invention of a control device 

20 of a legged mobile robot in accordance with the present 
invention, 

there is provided a control device of a legged mobile 
robot adapted to sequentially determine instantaneous 
values of a desired motion and a desired floor reaction 
25 force of a legged mobile robot, which travels by moving 

legs extended from its body, by using a dynamic model that 
expresses at least a relationship between a motion of the 
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robot and a floor reaction force, and also to control an 
operation of the robot at the same time so as to make the 
robot follow the determined instantaneous values of the 
desired motion and the desired floor reaction force, 
5 comprising: 

slippage determining means for determining the 
occurrence of a slippage of the robot in operation, 
following the desired motion and the desired floor 
reaction force; 

10 permissible range setting means for variably setting 

a permissible range of a restriction object amount 
according to a determination result of the slippage 
determining means, the restriction object amount being at 
least a horizontal component of a translational floor 

15 reaction force to be applied to the robot, or a component 
of the translational floor reaction force in parallel to a 
floor surface, or a horizontal component of a total 
center- of -gravity acceleration of the robot, or a 
component of the total center- of -gravity acceleration in 

20 parallel to a floor surface; and 

desired instantaneous value determining means for 
determining, on the basis of at least the difference 
between a desired state amount of a posture of the robot 
that corresponds to the determined instantaneous values of 

25 the desired motion and the desired floor reaction force 
and an actual state amount of the posture of the robot, 
new instantaneous values of the desired motion and the 



desired floor reaction force such that the restriction 
object amount determined on the basis of the dynamic model 
In correspondence to the new Instantaneous value of the 
desired motion falls within the permissible range and the 
difference approximates zero. 

According to the fourth Invention^ new Instantaneous 
values of the desired motion and the desired floor 
reaction force are determined, on the basis of at least 
the difference regarding a state amount of a posture of 
the robot, such that the restriction object amount (a 
horizontal component of a translatlonal floor reaction 
force, or a component of the translatlonal floor reaction 
force In parallel to a floor surface, or a horizontal 
component of a total center-of -gravity acceleration of the 
robot, or a component of the total center-of -gravity 
acceleration In parallel to a floor surface) determined on 
the basis of the dyncunlc model In correspondence to the 
new Instantaneous value of the desired motion falls within 
the permissible range and the difference approximates zero 
This means that the Instantaneous values of a desired 
motion and a desired floor reaction force are determined 
such that a restriction object amount will not deviate 
from a permissible range, while maintaining the posture of 
a robot at a desired posture (hereinafter, this condition 
may be referred to as "the posture/restriction object 
amount condition" as In the third Invention). And, In 
this case, the permissible range Is variably set according 
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to a detexmlnatlon result of the slippage determining 
means; therefore, as In the case of the third Invention, 
Instantaneous values of a desired motion and a desired 
floor reaction force can be quickly determined so as to 
satisfy the posture/restriction object amount condition, 
depending on whether or not a slippage of an actual robot 
has occurred. As a result, even If a slippage of the 
actual robot occurs, the slippage can be Immediately 
restrained, while stably maintaining the posture of the 
robot at a proper posture. Moreover, In this case, both 
desired motion and desired floor reaction force are 
restricted by the posture/restriction object amount 
condition, permitting effective restraint of a slippage to 
be achieved. 

In the first to fourth Inventions described above, 
the occurrence of a slippage can be determined^ for 
example, as follows. 

The slippage determining means determines the 
occurrence of a slippage on the basis of at least the 
ground speed of a distal portion of a leg in contact with 
the ground (a fifth invention). In this case, if, for 
example, the absolute value of the ground speed is larger 
than a predetermined value, then it can be determined that 
a slippage has occurred. 

Alternatively, the slippage determining means 
includes a means for determining, on the basis of at least 
a temporal changing rate of an actual floor reaction force 
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acting on a leg In contact with the ground and the ground 
speed of a distal portion of the leg, an apparent spring 
constant of the leg and determines the occurrence of a 
slippage on the basis of at least the apparent spring 
constant (a sixth Invention). In this case. If, for 
example, the apparent spring constant Is smaller than a 
predetermined value, then It can be determined that a 
slippage has occurred. 

Alternatively, the slippage determining means 
determines the occurrence of a slippage on the basis of at 
least a result obtained by passing an actual floor 
reaction force acting on a leg In contact with the ground 
through a band-pass filter having a frequency passing 
characteristic In a range near a predetermined frequency 
(a seventh Invention). In this case, the result obtained 
by passing the actual floor reaction force through a band- 
pass filter will correspond to the vibration component of 
an actual floor reaction force when a so-called slippage 
vibration Is occurring. And, If, for example, the 
magnitude (absolute value) of the vibration component Is 
larger than a predetermined value, then It can be 
determined that a slippage vibration Is occurring. 

The occurrence of a slippage can be determined In any 
one of the fifth to the seventh Inventions. Alternatively, 
two or more of the fifth to the seventh inventions may be 
combined to determine the occurrence of a slippage. 
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Brief Description of the Drawings 

Fig. 1 is a diagr€im schematically showing a general 
construction of a bipedal mobile robot as a legged mobile 
robot in an embodiment of the present invention and a 
reference example related thereto. Fig. 2 is a diagram 
showing a structure of a distal portion of a leg of the 
robot shown in Fig. 1, Fig. 3 is a block diagram showing a 
construction of a control unit provided in the robot shown 
in Fig. 1, and Fig. 4 is a block diagram showing a 
functional construction of the control unit in a first 
reference example. Fig. 5 is a diagram for explaining a 
running gait generated in the embodiment and the reference 
example. Fig. 6 is a graph showing an example of a 
vertical component trajectory of a desired floor reaction 
force. Fig. 7 shows graphs illustrating examples of an X 
component and a Y component of a desired ZMP trajectory. 
Fig. 8 is a diagram for explaining a body translational 
mode of a robot. Fig. 9 is a diagram for explaining a body 
inclination mode of the robot. Fig. 10 is a diagram for 
explaining a body yaw rotation mode of the robot. Fig. 
11(a) is a diagram for explaining an antiphase arm swing 
mode of the robot in a plan view and Fig. 11(b) is a 
diagram for explaining an antiphase arm swing mode of the 
robot in a side view, and Fig. 12 is a diagram for 
explaining a dynamic model used in the embodiment. Fig. 
13 is a flowchart showing a main routine processing of a 
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gait generating device in the first reference example. Pig, 
14 is a diagram for explaining a diversion state of the 
robot. Fig. 15 is a flowchart showing a subroutine 
processing of S022 of Fig. 13, Fig. 16 is a diagram for 
5 explaining a normal gait and a supporting leg coordinate 
system. Fig. 17 is a diagram illustrating a body 
trajectory of the normal gait and the supporting leg 
coordinate system. Fig. 18 is a graph showing an exeunple 
of a reference antiphase arm swing angle. Fig. 19 is a 

10 graph showing a setting example of a desired floor 

reaction force vertical component trajectory in a normal 
gait. Fig. 20 is a graph showing a setting example of a 
floor reaction force horizontal component permissible 
range in a normal gait. Fig. 21 is a graph showing a 

15 setting example of a floor reaction force moment vertical 
component permissible range in the normal gait, and Fig. 
22 is a graph showing a setting example of the desired ZMP 
trajectory in the normal gait. Fig. 23 is a flowchart 
showing subroutine processing of S024 in Fig. 13, Fig. 24 

20 is a flowchart showing subroutine processing of S208 in 
Fig. 23, Fig. 25 is a flowchart showing subroutine 
processing of S306 in Fig. 24, and Fig. 26 is a flowchart 
showing subroutine processing of S412 in Fig. 25. Fig. 27 
is a graph showing an example of a floor reaction force 

25 horizontal component in which a permissible range is not 
considered. Fig. 28 is a graph showing an example of the 
floor reaction force horizontal component in which a 
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permissible range Is considered. Fig. 29 Is a graph 
showing an example of a body Inclination angular 
acceleration. Fig. 30 Is a graph showing an excunple of a 
body Inclination restoring moment ZMP- converted value for 
5 restoring a body Inclination angle of the robot. Fig. 31 
Is a graph showing an example of a body Inclination 
angular acceleration In which the body Inclination 
restoring moment ZMP-converted value Is reflected. Fig. 32 
Is a graph showing an example of a floor reaction force 

10 moment vertical component In which a permissible range Is 
not considered. Fig. 33 Is a graph showing an example of a 
floor reaction force moment vertical component In which 
the permissible range Is considered. Fig. 34 Is a graph 
showing an example of an antiphase arm swing moment. Fig. 

15 35 Is a graph showing an antiphase arm swing angular 
acceleration corresponding to the antiphase arm swing 
moment shown In Fig. 34, Fig. 36 Is a graph showing an 
example of an antiphase arm swing restoring angular 
acceleration for restoring an antiphase arm swing angle, 

20 Fig. 37 Is a graph showing an antiphase arm swing 

restoring moment corresponding to an antiphase arm swing 
restoring angular acceleration shown in Fig. 36, and Fig. 
38 is a graph showing a floor reaction force moment 
vertical component formed by combining the floor reaction 

25 force moment vertical component shown in Fig. 33 and the 
antiphase arm swing restoring moment shown in Fig. 37. 
Fig. 39 is a flowchart showing subroutine processing of 
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S026 In Fig. 13, Fig. 40 Is a graph showing a setting 
example of a floor reaction force horizontal component 
permissible range of a current time gait. Fig. 41 Is a 
graph showing a setting example of a floor reaction force 
5 moment vertical component permissible range of the current 
time gait. Fig. 42 Is a flowchart showing subroutine 
processing of S028 In Fig. 13, Fig. 43 Is a flowchart 
showing subroutine processing of S702 In Fig. 42, Fig. 44 
Is a graph showing examples of a provisional desired ZMP 

10 of the current time gait, a ZMP correction amount, and a 
desired ZMP after correction. Fig. 45 Is a flowchart 
showing subroutine processing of S030 In Fig. 13, and Fig. 
46 Is a flowchart showing subroutine processing of S1412 
In Fig. 45. Fig. 47 Is a graph showing a relationship 

15 between normal gaits and desired gaits relative to body 
position trajectories. Fig. 48 is a diagram showing 
another example of a body inclination mode (body 
inclination about waist). Fig. 49 is a diagram for 
explaining another example of a dynamic model. Fig. 50 is 

20 a diagram showing a setting example of a desired floor 

reaction force vertical component in a walking gait. Fig. 
51 is a diagram showing a relationship between the 
positions of the body in a vertical direction and a floor 
reaction force vertical component in a running gait of the 

25 robot, and Fig. 52 is a diagram showing a relationship 

between the position of the body in a vertical direction 
and a floor reaction force vertical component in a walking 
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gait of the robot. Fig, 53 Is a block diagram showing a 
functional construction of a control unit In a second 
reference example. Fig. 54 Is a block diagram showing the 
processing of a compensating total floor reaction force 
moment horizontal component distributor shown In Fig. 53, 
Fig. 55 Is a block diagram showing the processing of a 
model manipulation floor reaction force moment vertical 
component determiner shown In Fig. 53, Fig. 56 Is a 
flowchart showing main routine processing of a gait 
generating device In the second reference example. Fig. 57 
Is a flowchart showing subroutine processing of S3032 In 
Fig. 56, and Fig. 58 is a flowchart showing a subroutine 
processing of S3414 in Fig. 57. Fig. 59 is a block 
diagram showing a functional construction of a control 
unit in a third reference example. Fig. 60 is a flowchart 
showing main routine processing of a gait generating 
device in a second embodiment. Fig. 61 is a flowchart 
showing subroutine processing of S2034 in Fig. 60, and Fig. 
62 is a flowchart showing subroutine processing of S2114 
in Fig. 61. Fig. 63 is a block diagram showing a 
functional construction of a gait generating device in a 
fourth reference example. Fig. 64 is a diagram showing a 
setting example of a ZMP permissible range in the fourth 
reference example. Fig. 65 is a flowchart showing main 
routine processing of the gait generating device in the 
fourth reference example. Fig. 66 Is a block diagram 
showing processing of S3536 in Fig. 65, Fig. 67 is a 
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diagram for explaining a horizontal body position 
perturbation model shown In Fig. 66, Fig, 68 Is a diagram 
for explaining a perturbation model for correcting body 
posture angle shown In Fig, 66, Fig. 69 Is a diagram for 
5 explaining a perturbation model for correcting antiphase 
arm swing angle shown In Fig. 66, and Fig. 70 Is a block 
diagram showing processing of an antiphase arm swing angle 
correcting perturbation model moment determiner shown In 
Fig. 66. Fig. 71 Is a block diagram showing processing of 

10 S3 536 In Fig. 65 In a fifth reference example, and Fig. 72 
Is a block diagram showing processing of the antiphase arm 
swing angle correcting perturbation model moment 
determiner shown In Fig. 71. Fig. 73 Is a block diagram 
showing a functional construction of a gait generating 

15 device In a sixth reference example, and Fig. 74 Is a 

block diagram showing processing of a pseudo order full 
model shown In Fig. 73. Fig. 75 Is a block diagram 
showing processing of S3536 In Fig. 65 In a seventh 
reference example. Fig. 76 Is a block diagram showing a 

20 functional construction of a control unit In a first 
embodiment of the present Invention, Fig. 77 Is a 
flowchart showing main routine processing of a gait 
generating device in the first embodiment. Fig. 78 is a 
flowchart showing processing of S2334 in Fig. 77, Fig. 79 

25 is a flowchart showing the processing of a slippage 
determiner shown in Fig. 76, Fig. 80 to Fig. 82 are 
flowcharts showing subroutine processing of S5210, S5212, 



and S5214, respectively. In Fig. 79, Fig. 83 Is a graph 
showing examples of determination results of the slippage 
determiner, reducing rates of a permissible range, and 
floor reaction force permissible ranges. Fig. 84 Is a 
block diagram showing modification examples related to the 
fifth to the seventh reference examples, and Fig. 85 Is a 
block diagram showing a modification example of the 
processing of the antiphase arm swing angle correcting 
perturbation model moment determiner related to the fourth 
example . 

Best Mode for Carrying Out the Invention 

Referring now to the accompanying drawings, control 
devices of legged mobile robots according to embodiments 
of the present invention will be explained. As the legged 
mobile robots, bipedal mobile robots will be used as 
examples . 

First, with reference to Fig. 1 to Fig. 47, a first 
reference example related to the control device of a 
legged mobile robot in accordance with the present 
invention will be explained. Further, a second reference 
example will be explained with reference to Fig. 53 to Fig 
38, a third reference example will be explained with 
reference to Fig. 59 to Fig. 62, a fourth reference 
example will be explained with reference to Fig. 63 to Fig 
70, a fifth reference example will be explained with 
reference to Fig. 71 and Fig. 72, a sixth reference 



example will be explained with reference to Fig. 73 and 
Fig. 74, and a seventh reference example will be explained 
with reference to Fig. 75. The embodiments of the present 
invention to be discussed hereinafter share the same 
mechanical construction as that of the first reference 
example, only gait generation processing and a part of 
control processing (specifically permissible range 
setting) of a robot being different from any one of the 
first to the seventh reference examples. For this reason, 
the explanation of the first to the seventh reference 
examples will be frequently used in the explanation of the 
embodiments to be discussed later. Supplementally, the 
same matters that will be explained with reference to Fig. 
1 and Fig. 2, Fig. 3 and Fig. 5 to Fig. 12 to be discussed 
later will apply to the embodiments to be discussed later. 

First, the first reference example will be explained. 
Fig. 1 is a schematic diagram generally showing a bipedal 
mobile robot representing a legged mobile robot according 
to the first reference example. 

As shown in the figure, a bipedal mobile robot 
(hereinafter referred to as "the robot") 1 is equipped 
with a pair of right and left legs (leg links) 2, 2 
provided such that they extend downward from a body (a 
base body of the robot 1) 3. The two legs 2, 2 share the 
same construction, each having six joints. The six joints 
of each leg are comprised of, in the following order from 
the body 3 side, joints lOR, lOL (symbols R and L meaning 
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correspondence to the right leg and the left leg, 
respectively; the same will be applied hereinafter) for 
swinging (rotating) a hip (waist) (for rotating in a yaw 
direction relative to the body 3), joints 12R, 12L for 
rotating the hip (waist) in a roll direction (about an X 
axis), joints 14R, 14L for rotating the hip (waist) in a 
pitch direction (about a Y axis), joints 16R, 16L for 
rotating knees in the pitch direction, joints 18R, 18L for 
rotating ankles in the pitch direction, and joints 20R, 
20L for rotating the ankles in the roll direction • 

A foot (foot portion) 22R (L) constituting a distal 
portion of each leg 2 is attached to the bottoms of the 
two joints 18R (L) and 20R (L) of the ankle of each leg 2. 
The body 3 is installed at the uppermost top of the two 
legs 2, 2 through the intermediary of the three joints ICR 
(L), 12R (L) and 14R (L) of the hip of each leg 2. A 
control unit 60 or the like, which will be discussed in 
detail hereinafter, is housed inside the body 3. For 
convenience of illustration, the control unit 60 is shown 
outside the body 3 in Fig. 1. 

In each leg 2 having the aforesaid construction, a 
hip joint (or a waist joint) is formed of the joints lOR 
(L), 12R (L) and 14R (L) , the knee joint is formed of the 
joint 16R (L), and the ankle joint is formed of the joints 
18R (L) and 20R (L) . The hip joint and the knee joint are 
connected by a thigh link 24R (L) , and the knee joint and 
the ankle joint are connected by a crus link 26R (L). 
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A pair of right and left arms 5, 5 Is attached to 
both sides of an upper portion of the body 3, and a head 4 
Is disposed at a top end of the body 3. Each arm 5 is 
provided with a shoulder Joint composed of three Joints 
30R (L), 32R (L), and 34R (L) , an elbow Joint composed of 
a Joint 36 R(L), a wrist Joint composed of a joint 38R (L), 
and a hand 40R (L) connected to the wrist Joint. The head 
4 is not directly connected to the topic of the present 
invention, so that detailed explanation thereof will be 
omitted. 

According to the construction described above, the 
foot 22R (L) of each leg 2 is given six degrees of freedom 
relative to the body 3. During a travel, such as walking, 
of the robot 1, desired motions of the two feet 22R and 
22L can be accomplished by driving 6*2=12 Joints of the 
two legs 2, 2 together in the present description 

denotes multiplication as scalar calculation, while it 
denotes an outer product in vector calculation) at 
appropriate angles . This arrangement enables the robot 1 
to arbitrarily move in a three-dimensional space. 
Furthermore, each arm 5 can perform a motion, such as arm 
swinging, by rotating its shoulder Joint, the elbow joint, 
and the wrist Joint. 

As shown in Fig. 1, a publicly known six-axis force 
sensor 50 is provided between the ankle Joints 18R (L), 
20R (L) and the foot 22R (L) of each leg 2. The six-axis 
force sensor 50 detects primarily whether the foot 22R (L) 
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of each leg 2 is in contact with the ground, and a floor 
reaction force (landing load) acting on each leg 2, and it 
outputs detection signals of three -direction components Fx, 
Fy, and Fz of a translational force of the floor reaction 
force and three -direction components Mx, My, and Mz of a 
moment to the control unit 60, Furthermore, the body 3 is 
equipped with a posture sensor 54 for detecting an 
inclination angle of the body 3 relative to a Z-eucis 
(vertical direction (gravitational direction)) and an 
angular velocity thereof, and a rotational angle (yaw 
angle) of the body 3 about the Z-axis and an angular 
velocity thereof, detection signals thereof being output 
from the posture sensor 54 to the control unit 60. The 
posture sensor 54 is provided with a three-axis direction 
accelerometer and a three-axis direction gyro sensor, 
which are not shown. These detection signals of these 
sensors are used to detect posture angles (an inclination 
angle and a yaw angle) of the body 3 and an angular 
velocity thereof, and also used to estimate a self 
position/posture of the robot 1. Although detailed 
structures are not shown, each joint of the robot 1 is 
provided with an electric motor 64 (refer to Fig. 3) for 
driving the joint, and an encoder (rotary encoder) 65 
(refer to Fig. 3) for detecting a rotational amount of the 
electric motor 64 (a rotational angle of each joint). 
Detection signals of the encoder 65 are output from the 
encoder 65 to the control unit 60. 



Furthermore, although not shown in Fig. 1, a joystick 
(operating device) 73 (refer to Fig. 3) is provided at an 
appropriate position of the robot 1. The joystick 73 is 
constructed in such a manner that a request regarding a 
gait of the robot 1, such as a request for turning the 
robot 1 that is traveling straight, is input to the 
control unit 60 as necessary by operating the joystick 73. 

Fig. 2 is a diagram schematically showing a basic 
construction of a distal portion (including each foot 22R 
(L)) of each leg 2 in the first reference example. As 
shown in the diagram, a spring mechanism 70 is installed 
between each foot 22R (L) and the six-eixis force sensor 50, 
and a foot sole elastic member 71 made of rubber or the 
like is bonded to a foot sole (the bottom surface of each 
foot 22R (L)). These spring mechanism 70 and the foot 
sole elastic member 71 constitute a compliance mechanism 
72. The spring mechanism 70, which will be discussed in 
detail later, is constructed of a square guide member (not 
shown) , which is installed on the upper surface of the 
foot 22R (L), and a piston-shaped member (not shown) 
installed adjacently to the ankle joint 18R (L) (the ankle 
joint 20R (L) being omitted in Fig. 2) and the six-axis 
force sensor 50, and housed in the guide member through 
the intermediary of an elastic member (rubber or spring) 
so that it may be jogged. 

The foot 22R (L) indicated by a solid line shown in 
Fig. 2 is in a state where it is subjected to no floor 
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reaction force. When each leg 2 Is subjected to a floor 
reaction force, the spring mechanism 70 and the foot sole 
elastic member 71 of the compliance mechanism 72 flex, 
causing the foot 22R (L) to shift to the position/posture 
5 Illustrated by a dashed line In the figure. The structure 
of the compliance mechanism 72 Is Important not only to 
ease a landing Impact but also to enhance controllability, 
as explained In detail In, for example, Japanese 
Unexamined Patent Publication Application No. 5-305584 

10 previously proposed by the present applicant. 

Fig. 3 Is a block diagram showing a construction of 
the control unit 60. The control unit 60 Is comprised of 
a microcomputer, and Includes a first calculator 90 and a 
second calculator 92 formed of CPUs, an A/D converter 80, 

15 a counter 86, a D/A converter 96, a RAM 84, a ROM 94, and 
a bus line 82 for transferring data among them. In the 
control unit 60, output signals of the slx-axls force 
sensor 50 of each leg 2, the posture sensor 54 (an 
accelerometer and a rate gyro sensor), the joystick 73, 

20 etc. are converted Into digital values by the A/D 

converter 80 and sent to the RAM 84 via the bus line 82. 
Outputs of the encoder 65 (rotary encoder) of each joint 
of the robot 1 are supplied to the RAM 84 via the counter 
86. 

25 As will be discussed hereinafter, the first 

calculator 90 generates desired gaits, calculates a joint 
angle displacement command (a command value of a 
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displacement angle of each joint or a rotational angle of 
each electric motor 64), and sends the calculation result 
to the RAM 84. The second calculator 92 reads the joint 
angle displacement command and an actual measurement value 
of a joint angle detected on the basis of an output signal 
of the encoder 65 from the RAM 84 to calculate a 
manipulated variable required for driving each joint, and 
outputs the calculated variable to the electric motor 64 
for driving each joint through the intermedieory of the D/A 
converter 96 and a servo amplifier 64a. 

Fig. 4 is a block diagram showing the entire 
functional construction of a control device of the legged 
mobile robot in accordance with the first reference 
example. A portion except for the "actual robot' in Fig. 
4 is constituted by processing functions implemented by 
the control unit 60 (primarily the functions of the first 
calculator 90 and the second calculator 92). In the 
following explanation, the symbols R and L will be omitted 
as long as it is not particularly necessary to 
discriminate right and left of the legs 2 and the arms 5. 

The explanation will now be given. The control unit 
60 is equipped with a gait generating device 100 for 
generating desired gaits of the robot 1 freely in real 
time and output ting them. The functions of the gait 
generating device 100 constitute individual means of the 
present invention. A desired gait output by the gait 
generating device 100 is constituted of a desired body 
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position/posture trajectory (trajectory of a desired 
position and a desired posture of the body 3), a desired 
foot position/posture trajectory (trajectory of a desired 
position and a desired posture of each foot 22), a desired 
arm posture trajectory (trajectory of a desired posture of 
each arm 5), a desired total floor reaction force central 
point (desired ZMP) trajectory, and a desired total floor 
reaction force trajectory. If a movable part relative to 
the body 3 is provided in addition to the legs 2 and the 
arms 5, then a desired position/posture trajectory of the 
movable part is added to the desired gait. 

Here, the term "trajectory" in the above gait means a 
temporal change pattern (time series pattern), and may be 
referred to as "pattern" in place of "trajectory" in the 
following explanation. Furthermore, a "posture" means a 
spatial orientation. Specifically, for example, a posture 
of a body is represented by an inclination angle of the 
body 3 in the roll direction (about the X-axis) relative 
to the Z-axis (vertical axis), an inclination angle of the 
body 3 in the pitch direction (about the Y-axis), and a 
rotational angle (yaw angle) of the body 3 in the yaw 
direction (about the Z-axis). A foot posture is 
represented by means of a spatial azimuth of two cixes 
fixedly set on each foot 22. In the present description, 
a body posture may be referred to as a body posture angle. 
Of body postures, a posture relative to a vertical 
direction may be referred to as a body posture inclination 
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or a body posture inclination angle. 

In the following explanation, the term "desired" will 
be frequently omitted when there is no danger of 
misunderstanding. Furthermore, among gaits, those gaits 
5 related to constituent elements other than those related 
to a floor reaction force, that is, the gaits related to 
motions of the robot 1, such as a foot position/posture 
and a body position/posture, will be collectively referred 
to as "motion." A floor reaction force (floor reaction 

10 force comprised of a translational force and a moment) 

acting on each foot 22 is referred to as "each-foot floor 
reaction force", and a resultant force of the "each-foot 
floor reaction forces" of all (two) feet 22R and 22L of 
the robot 1 will be referred to as a "total floor reaction 

15 force". In the following explanation, however, each-foot 
floor reaction force will hardly be referred to, so that 
"floor reaction force" will be handled as having the same 
meaning as "total floor reaction force" unless otherwise 
specified* 

20 A desired floor reaction force is generally expressed 

by a point of action and a translational force and the 
moment acting on the point. The point of action may be 
set at any location, so that innumerable expressions are 
possible for the same desired floor reaction force. If, 

25 however, a desired floor reaction force is expressed using 
especially a desired floor reaction force central point (a 
desired position of the central point of a total floor 
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reaction force) as the point of action, then the moment 
component of the desired floor reaction force will be zero 
except for a vertical component (the moment about the 
vertical axis (Z-eocls)). In other words, the horizontal 
component of the moment of the desired floor reaction 
force about the desired floor reaction force central point 
(the moment about the horizontal axis (the X-axls and the 
Y-axls)) will be zero. 

In the case of a gait that satisfies dyncunlc balance 
conditions, a ZMP calculated from a desired motion 
trajectory of the robot 1 (a point at which the moment of 
a resultant force of an Inertlal force and gravity 
calculated from the desired motion trajectory acts about 
the point becomes zero except for a vertical component) 
agrees with a desired floor reaction force central point. 
Therefore, providing a desired ZMP trajectory may be 
regarded as equivalent to providing a desired floor 
reaction force central point trajectory (refer to, for 
example, PCT Kokal publication WO/02/40224 by the present 
applicant, for more detail). 

From the background described above. In the 
description of PCT Kokal publication WO/02/40224, a 
desired gait has been defined as follows. 

a) In a broad sense, a desired gait Is a combination of a 
desired motion trajectory and a desired floor reaction 
force trajectory thereof In a period of one step or a 
plurality of steps. 



- 37 - 



b) In a narrow sense, a desired gait is a combination of a 
desired motion trajectory and a ZMP trajectory thereof in 
a period of one step. 

c) A series of gaits is formed of several gaits that are 
connected. 

In walking, once a vertical position of the body 3 of 
the robot 1 (a height of the body) is determined by a body 
height determining technique proposed previously in 
Japanese Unexamined Patent Application Publication No. 10- 
86080 by the present applicant, a translational floor 
reaction force vertical component is subordinately 
determined. Furthermore, a translational floor reaction 
force horizontal component is also determined by 
determining the horizontal body position trajectory of the 
robot 1 such that the horizontal component of the moment 
produced about a desired ZMP by a resultant force of the 
inertial force and the gravity generated by the motion of 
a desired gait becomes zero. For this reason, a desired 
ZMP alone has been adequate as a physical amount to be 
explicitly set for the floor reaction force of a desired 
gait in the description of PCT Kokai publication 
WO/02/40224. Thus, the definition in the above b) has 
been adequate as the definition of a desired gait in the 
narrow sense. However, in the running gait of the robot 1 
explained in the first reference example (the details will 
be described hereinafter), a floor reaction force vertical 
component (a translational floor reaction force vertical 
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component) Is also important for control. In the present 
invention, therefore, a desired trajectory of the floor 
reaction force vertical component is explicitly set, and 
then a trajectory of a desired vertical body position or 
the like of the robot 1 is determined. Hence, in the 
present description , the following b ' ) will be adopted as 
the definition of a desired gait in a narrow sense, 
b') A desired gait in a narrow sense is a combination of a 
desired motion trajectory in a period of one step and a 
desired floor reaction force trajectory including at least 
a desired ZMP trajectory of the desired motion trajectory 
and a desired translational floor reaction force vertical 
component trajectory. 

In the present description, a desired gait used 
hereinafter will mean the desired gait in the narrow sense 
of the above b') unless otherwise specified for the 
purpose of easy understanding. In this case, '"one step" 
of a desired gait will mean a period from the moment one 
leg 2 of the robot 1 touches the ground to the moment the 
other leg 2 touches the ground. Supplementally, in the 
reference examples and embodiments in the present 
description, a desired gait is used to mean a gait for 
one-step period. This, however, does not have to be 
necessarily the one- step period; it may alternatively be a 
period for a plurality of steps or a period that is 
shorter than one step (e.g., a half step). In the 
following explanation, "floor reaction force vertical 
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component" will mean " trans lational floor reaction force 
vertical component," and the term "moment" will be used 
for the vertical component (the component about the 
vertical axis) of a moment of a floor reaction force so as 
5 to distinguish It from the * floor reaction force vertical 
component," Similarly, "floor reaction force horizontal 
component" will mean "trans lational floor reaction force 
horizontal component . " 

Needless to say, a double stance period in a gait 

10 refers to a period during which the robot 1 supports its 
own weight by the two legs 2, 2. A single stance period 
refers to a period during which the robot 1 supports its 
own weight only by one leg 2, and a floating period refers 
to a period during which both legs 2, 2 are apart from a 

15 floor (floating in the air). In the single stance period, 
the leg 2 not supporting the self -weight of the robot 1 is 
referred to as a "free leg." The running gait explained 
in the present first reference example does not have the 
double stance period, but alternately repeats the single 

20 stance period (landing period) and the floating period. 

In this case, during the floating period, both legs 2, 2 
do not support the self -weight of the robot 1; however, 
the leg 2 that was a free leg and the leg 2 that was a 
supporting leg during a single stance period immediately 

25 before the floating period will be referred to as a "free 
leg" and a "supporting leg," respectively, even in the 
floating period. 
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Taking the running gait shown in Fig. 5 as an example, 
an outline of a desired gait generated by the gait 
generating device 100 will be explained. More definitions 
and details related to gaits have been given also in 
5 Japanese Unexamined Patent Application Publication No. 10- 
86081 previously proposed by the present applicant, so 
that the following will mainly give a description not 
covered by the Japanese Unexamined Patent Application 
Publication No. 10-86081. 

10 First, the running gait shown in Fig. 5 will be 

explained. This running gait is a gait similar to a 
typical htunan running gait. In this running gait, the 
single stance period in which the foot 22 of only either 
the right or left leg 2 (supporting leg) of the robot 1 

15 lands (contacts the ground) and a floating period in which 
both the legs 2, 2 float in the air are alternately 
repeated. In Fig. 5, the first state illustrates a state 
wherein a single stance period has begun (initial stage), 
the second state illustrates a state of a midpoint of the 

20 single stance period, the third state illustrates a state 
wherein a floating period following the single stance 
period has begun (an end of the single stance period), the 
fourth state illustrates a state of a midpoint of the 
floating period, and the fifth state illustrates an end of 

25 the floating period (a start of the next single stance 
period) . 

In this running gait, the robot 1 lands at the heel 
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Of the foot 22 of the supporting leg (the leg 2 on the 
front side In the advancing direction of the robot 1) at 
the beginning of the single stance period, as shown in the 
first state of Fig. 5. Subsequently, the robot 1 brings 
5 substantially the entire surface of the sole of the landed 
foot 22 (the foot 22 of the supporting leg) into contact 
with the ground as shown in the second state of Fig. 5, 
and then kicks the floor with the tiptoe of the foot 22 
(the foot 22 of the leg 2 on the rear side with respect to 

10 the advancing direction of the robot 1 in the third state 
of Fig. 5) of the supporting leg to jump into the air, as 
shown in the third state of Fig. 5. This ends the single 
stance period and starts the floating period at the same 
time. The free leg in the single stance period exists 

15 behind the supporting leg at the beginning of the single 
stance period, as shown in the first state of Fig. 5, but 
swung out to the front of the supporting leg toward the 
next predetermined landing position, as shown in the 
second and the third states of Fig. 5. Next, following 

20 the floating period shown in the fourth state of Fig. 5, 
the robot 1 lands at the heel of the foot 22 of the free 
leg (the leg 2 that was the free leg in the single stance 
period immediately before the floating period started) , 
and the next single stance period is begun. 

25 Considering the running gait shown in Fig. 5, a basic 

outline of a desired gait generated by the gait generating 
device 100 will be explained. Although more details will 
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be discussed later, when the gait generating device 100 
generates a desired gait, basic required values (required 
parameters) for generating the desired gait, such as a 
landing position/posture (expected landing 
5 position/posture) of the foot 22 of a free leg and a 

landing time (expected landing time), are supplied to the 
gait generating device 100 according to a required 
operation or the like of the joystick 73. The gait 
generating device 100 then generates the desired gait 

10 using the required parameters. More detalledly, the gait 
generating device 100 determines parameters (referred to 
as gait parameters) that specify some constituent elements 
of the desired gait, such as a desired foot 
position/posture trajectory and a desired floor reaction 

15 force vertical component trajectory of the desired gait, 
on the basis of the above required parameters, and then 
sequentially determines Instantaneous values of the 
desired gait by using the gait parameters so as to 
generate a time series pattern of the desired gait. 

20 In this case, a desired foot position/posture 

trajectory (to be more specific, a desired trajectory of 
each spatial component (X-axls component or the like) of 
the position and the posture of a foot) Is generated for 
each foot 22 by using a finite-duration setting filter 

25 proposed In Japanese Patent No. 3233450 by the present 

applicant. This finite-duration setting filter Includes a 
plurality of stages (3 states or more in the present first 
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reference example) of first -order lag filters of variable 
time constants, that is, filters represented in terms of a 
transfer function of 1/(1+ts)(t is a variable time 
constant. Hereinafter, the filter will be referred to as 
5 a unit filter) , the plurality of stages of the filters 
being connected in series. This arrangement makes it 
possible to generate and output a trajectory that reaches 
a specified value at desired specified time. In this case, 
time constant x of the unit filter of each stage is always 

10 variably set in sequence according to remaining time until 
the above specified time after starting the generation of 
an output of the finite -duration setting filter. More 
specifically, the setting is made such that, the value of 
T is decreased from a predetermined initial value (>0) as 

15 the remaining time reduces, and the value of x finally 

reaches zero at the specified time at which the remaining 
time reaches zero. A step input of a height based on the 
specified value (more specifically, a change amount from 
an initial value to the specified value of an output of 

20 the finite- duration setting filter) is supplied to the 
finite -duration setting filter. The finite -duration 
setting filter not only generates an output that reaches a 
specified value at specified time but also makes it 
possible to set a changing rate of an output of the 

25 finite-duration setting filter at specified time to zero 
or substantially zero. Especially when three stages or 
more (three stages will do) of the unit filter are 
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connected, the changing acceleration (a differential value 
of a changing rate) of an output of the finite -duration 
setting filter can be reduced to zero or substantially- 
zero. 

The desired foot position/posture trajectory 
generated by the finite-duration setting filter as 
described above is the desired position/posture trajectory 
of each foot 22 on a supporting leg coordinate system, 
which is fixed on a floor surface and which is to be 
discussed later. 

The desired foot position/posture trajectory 
generated as described above is generated such that the 
position of each foot 22 begins moving, while gradually 
accelerating from the initial in-contact-with-the-ground 
state (the state at the initial time of a desired gait) 
toward an expected landing position. Further, the desired 
foot position/posture trajectory is generated such that 
the changing rate of the position is gradually decelerated 
to zero or substantially zero until the expected landing 
time is finally reached, and the expected landing position 
is reached at the expected landing time at which the 
trajectory comes to its end. Hence, the ground speed at 
the moment each foot 22 lands becomes zero or 
substantially zero (the changing rate of the position of 
each foot 22 on the supporting leg coordinate system 
secured to a floor) . Accordingly, a landing impact will 
be low even when the robot 1 lands from the state wherein 
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all legs 2, 2 are simultaneously present in the air (the 
state in the floating period) in a running gait. 

In the aforesaid running gait, the vertical velocity 
of the body 3 switches downward from the latter half of 
5 the floating period due to the gravity acting on the robot 
1, and remains downward even at the time of landing. 
Therefore, if the desired foot position/posture trajectory 
is generated such that the ground speed at the moment each 
foot 22 lands reaches zero or substantially zero, as 

10 described above, and if the desired position/posture 

trajectory of the body 3 is generated to satisfy a dynamic 
balance condition, as will be discussed later, then the 
relative velocity of the foot 22 of a free leg with 
respect to the body 3 switches upward immediately before 

15 landing. This means that, at a landing moment of a 

running gait, the desired gait of the robot 1 is such that 
the robot 1 lands while withdrawing the leg 22 that is a 
free leg toward the body 3 . In other words , according to 
the desired gait in the present first reference example, 

20 the robot 1 lands while pulling the foot 22 up, as 

observed from the body 3, so that the ground speed of the 
foot 22 of the free leg reaches zero or substantially zero. 
This restrains a landing impact to prevent the landing 
impact from becoming excessive. 

25 Furthermore, in the present first reference example, 

the finite-duration setting filter is composed of three 
stages of more (e.g., three stages) of the unit filters 
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connected in series, so that the velocity of each foot 22 
(the changing rate of a foot position) reaches zero or 
substantially zero by expected landing time and the 
acceleration of each foot 22 also reaches zero or 
substantially zero at the expected landing time when the 
foot 22 stops. This means that the ground acceleration 
also becomes zero or substantially zero at the landing 
Instant. Hence, the landing Impact will be further 
restrained. Especially, even If actual landing time of 
the robot 1 deviates from desired landing time, the Impact 
no longer Increases much. Supplementally, the number of 
stages of the unit filters of the finite -duration setting 
filter may be two to make setting so that the ground speed 
of each foot 22 reaches zero or substantially zero at 
expected landing time. In this case, however, the 
acceleration of each foot 22 at expected landing time does 
not usually become zero. 

Regarding a foot posture, after each foot 22 lands at 
Its heel at expected landing time, the foot continues to 
move until substantially the entire sole of the foot 22 
comes In contact with a floor. For this reason, the foot 
posture trajectory Is generated by the finite-duration 
setting filter, setting the time at which substantially 
the entire sole of the foot 22 comes In contact with the 
floor to the above specified time. 

In the present first reference example, the foot 
position trajectory has been generated using the finite- 
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duration setting filter. Alternatively, however, a 
desired foot position trajectory may be generated using a 
function, such as a polynomial, that Is set such that the 
changing rate of a foot position at expected landing time 
5 (a time differential value of a foot position) reaches 
zero or substantially zero and further the changing 
acceleration of the foot position at the expected landing 
time (a time differential value of the changing rate) 
reaches zero or substantially zero. This applies also to 

10 the generation of a desired foot posture trajectory. 

However, regarding the generation of the desired foot 
posture trajectory, a function, such as a polynomial. Is 
set such that the changing rate of the posture of each 
foot 22 and the changing acceleration thereof reaches zero 

15 or substantially zero at the time when substantially the 

entire sole of each foot 22 comes In contact with a floor, 
as described above. 

A desired floor reaction force vertical component 
trajectory Is set as shown In, for example. Fig. 6. In 

20 the present first reference example, the shape of a 

desired floor reaction force vertical component trajectory 
In a running gait (strictly speaking, the shape In a 
single stance period) Is specified to be trapezoidal (a 
shape projecting to an Increasing side of a floor reaction 

25 force vertical component). The height of the trapezoid 
and the time of a bending point are regarded as gait 
parameters defining a desired floor reaction force 
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vertical component trajectory In determining the gait 
parameters (floor reaction force vertical component 
trajectory parameters). In a floating period of a running 
gait, the desired floor reaction force vertical component 
Is steadily set to zero. As In the case of the present 
example, a desired floor reaction force vertical component 
trajectory Is preferably set so that It Is virtually 
continuous (so that values are not discontinuous). This 
Is for ensuring smooth operations of joints of the robot 1 
when controlling a floor reaction force. The term 
"virtually continuous" means that a skipped value that 
Inevitably takes place when a trajectory that Is 
continuous In an analog fashion (a continuous trajectory 
In a true meaning) Is digitally expressed by a discrete- 
time system does not cause the continuity of the 
trajectory to be lost. 

A desired ZMP trajectory Is set as follows. In the 
running gait shown In Fig. 5, as described above, the 
robot 1 lands at the heel of the foot 22 of a supporting 
leg, and then kicks at the tiptoe of the foot 22 of the 
supporting leg to jump Into the air. Lastly, the robot 1 
lands at the heel of the foot 22 of a free leg, as 
described above. Therefore, as shown In the upper diagram 
of Fig. 7, the desired ZMP trajectory In the single stance 
period Is set such that It takes the heel of the foot 22 
of the supporting leg as Its Initial position, and then 
extends to the center In the longitudinal direction of the 
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foot 22 In the period In which substantially the entire 
sole of the foot 22 of the supporting leg comes in contact 
with the ground, and thereafter, reaches the tiptoe of the 
foot 22 of the supporting leg by floor leaving time. Here, 
5 the upper diagram of Fig. 7 shows a desired ZMP trajectory 
in an X-axis direction (longitudinal direction), while a 
lower diagrcim of Fig. 7 shows a desired ZMP trajectory in 
a Y-axis direction (lateral direction). The desired ZMP 
trajectory in the Y-axis direction in a single stance 

10 period is set at the seune position as the central position 
of an ankle joint of a supporting leg 2 in the Y-axis 
direction, as shown in the lower diagram of Fig. 7. 

In a running gait, after a single stance period ends, 
both legs 2, 2 leave a floor, and the floor reaction force 

15 vertical component becomes zero. When the floor reaction 
force vertical component is zero, that is, during a 
floating period, the total center of gravity of the robot 
1 is subject to free fall motion, and an angular momentum 
change about the total center of gravity is zero. At this 

20 time, the moment of a resultant force of gravity and an 
inertial force that acts on the robot 1 is zero at an 
arbitrary point of a floor, so that a desired ZMP is 
indefinite. This means that any point of the floor 
satisfies a condition of ZMP represented by "a point of 

25 action at which the horizontal component of the moment, in 
which a resultant force of gravity and an inertial force 
acts, is zero." In other words, setting the desired ZMP 
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at an arbitrary point satisfies a dynamic balance 
condition In that the horizontal component of the moment 
In which the above resultant force acts about the desired 
ZMP Is zero. Hence, the desired ZMP may be set 
dlscontlnuously. For example, the desired ZMP may be set 
so that It does not move from a desired ZMP position when 
leaving a floor (when a single stance period ends) In a 
floating period, and It moves dlscontlnuously (in steps) 
to a desired ZMP position for landing at the end of the 
floating period. In the present first reference example, 
however, the position of the desired ZMP trajectory In the 
X-axls direction In a floating period has been set so as 
to continuously move to the landing position of the heel 
of the foot 22 of a free leg from the tiptoe of the foot 
22 of a supporting leg by the time the next free leg 2 
lands, as shown In the upper diagram of Fig. 7. Further, 
as shown In the lower diagram of Fig. 7, the position of 
the desired ZMP trajectory In the Y-axls direction In a 
floating period has been set so as to continuously move to 
the Y-axls directional position of the center of the ankle 
joint of a free leg 2 from the Y-axls directional position 
of the center of the ankle joint of a supporting leg 2 by 
the time the next free leg 2 lands. In other words, the 
desired ZMP trajectory has been set so that It Is 
continuous (virtually continuous) In all periods of a gait. 
As It will be discussed hereinafter, a desired gait has 
been generated so that a moment of the resultant force of 
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gravity and an inert ial force (excluding a vertical 
component) about the desired ZMP becomes zero (to be more 
specific, a desired body position/posture trajectory has 
been adjusted) . Taking an approximation error Into 
account, the desired ZMP trajectory Is desirably set to be 
continuous (virtually continuous) also In a floating 
period In order to ensure a smooth generated gait. 
However, a dynamic model, which Is used In the present 
first reference example and which will be discussed later, 
makes It possible to uniquely generate a desired gait that 
sets the horizontal component of a moment about a desired 
ZMP at a certain value (the value Is zero In the present 
first reference example, whereas It Is not necessarily 
zero In embodiments, which will be described hereinafter) 
Independently of the position of a desired ZMP. Therefore, 
the desired ZMP does not have to be always continuous. 

In the present first reference example, the positions 
and time of the bending points of the desired ZMP 
trajectory as shown in Fig. 7 are set as ZMP trajectory 
parameters (parameters defining the desired ZMP 
trajectory). The meaning of "virtually continuous" of the 
aforementioned ZMP trajectory is the same as that in the 
case of the above floor reaction force vertical component 
trajectory. 

The ZMP trajectory parameters are determined such 
that a high stability margin is secured and no sudden 
change takes place. Here, a state in which a desired ZMP 



- 52 - 



exists near the center of a least convex polygon (so- 
called supporting polygon) that includes a ground contact 
surface of the robot 1 indicates a high stability margin 
(refer to Japanese Unexamined Patent Application 
Publication No. 10-86081 for more detail). The desired 
ZMP trajectory shown in Fig. 7 has been set to meet such a 
condition. 

A desired body position/posture, a desired foot 
position/posture^ and a reference body posture, which will 
be discussed hereinafter, are described in terms of a 
global coordinate system. The global coordinate system is 
a coordinate system fixed to a floor. More specifically, 
a supporting leg coordinate system to be discussed 
hereinafter is used as the global coordinate system. 

In the present first reference example, the gait 
generating device 100 generates a reference body posture 
in addition to a desired body posture. The reference body 
posture is a body posture generated directly on the basis 
of requests regarding a gait (requests from a unit, such 
as an action scheduler, or from an external source (the 
Joystick 73 or the like) sent to the gait generating 
device 100) . 

A desired body posture (representing hereinafter a 
desired body posture unless "reference" is added) is 
generated such that it follows or agrees with a reference 
body posture in a long term. 

In walking, generally, a desired body posture may be 
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always set to agree with a reference body posture as In 
the case of an embodiment disclosed In the description of 
PCT Kokal publication WO/02/40224. Although the PCT Kokal 
publication WO/02/40224 does not refer to the concept of a 
reference body posture. It explicitly and preferentially 
gives desired body posture patterns, which Is equivalent 
to steady agreement of desired body postures with 
reference body postures. 

However, In a gait Including a floating period, as In 
running, or walking on a low-frlctlon floor surface, 
simply adjusting a horizontal body acceleration or the 
like Is not enough to satisfy a dynamic balance condition 
while maintaining a floor reaction force horizontal 
component and a floor reaction force vertical component of 
a desired gait within a permissible range (or within a 
friction limit) at the same time. 

In the present first reference example, therefore, a 
desired body posture Is deliberately deviated from a 
reference body posture, as necessary. To be more specific, 
motion modes explained below are generated in a combined 
manner so as to satisfy the dynamic balance condition 
while having a floor reaction force horizontal component 
and a floor reaction force moment vertical component of a 
desired gait fall within a permissible range (or within a 
friction limit) . 

As shown in Fig. 8, when the robot 1 is in a certain 
motion state, if only a horizontal body acceleration is 



perturbated (slightly changed), then a total center-of- 
gravity horizontal acceleration and an angular momentum 
about the total center -of -gravity of the robot 1 are 
perturbated. More specifically, perturbating the 
horizontal body acceleration perturbates the floor 
reaction force moment horizontal component about a desired 
ZMP (a component about the horizontal axis) and the floor 
reaction force horizontal component without perturbating 
the floor reaction force vertical component that 
dyneunically balances with a resultant force of an inertial 
force and gravity of the robot 1 produced by the 
perturbation of the horizontal body acceleration (without 
perturbating a total center -of -gravity vertical 
acceleration of the robot 1). The motion mode that 
perturbs the horizontal body acceleration of the robot 1 
as described above is referred to as a body translational 
mode. 

In other words, a motion in which the floor reaction 
force moment horizontal component about the desired ZMP 
and the floor reaction force horizontal component are 
changed without changing the floor reaction force vertical 
component is referred to as the body translational mode. 
In the body translational mode, the floor reaction force 
moment vertical component (the component about the 
vertical axis) is also perturbated; however, no attention 
will be paid to this aspect in this case. 

A change in the floor reaction force moment 
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horizontal component per unit acceleration at this time Is 
denoted by AMp and a change In the floor reaction force 
horizontal component per unit acceleration Is denoted by 
AFp. If the body 3 Is horizontally accelerated forward In 
the situation Illustrated In Fig. 8, then AMp and AFp act 
In the directions of the arrows shown In Fig. 8. 

To facilitate perceptual understanding, the floor 
reaction force that balances with the resultant force of 
an Inertlal force and gravity generated by a motion has 
been used for expression. However, It Is theoretically 
more accurate to express using the resultant force of an 
Inertlal force and gravity. The above resultant force and 
the floor reaction force have the same magnitude but 
opposite directions. 

In comparison with the above. If the body Inclination 
angular acceleration (the angular acceleration of the 
Inclination angle of the body 3) Is perturbated about a 
certain point Pr from a certain motion state of the robot 
1, as shown In Fig. 9, then the angular momentum 
(excluding the component about the vertical axis) about 
the total center- of -gravity Is perturbated, while the 
total center-of -gravity of the robot 1 remains 
unperturbated. This means that perturbatlng the body 
Inclination angle acceleration about the point Pr 
perturbates the floor reaction force moment horizontal 
component about a desired ZMP without perturbatlng the 
floor reaction force vertical component and the floor 
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reaction force horizontal component. The motion mode in 
which the body inclination angle acceleration of the robot 
1 is perturbated as described above is referred to as the 
body inclination mode. 

In other words, the motion in which the floor 
reaction force moment horizontal component about a desired 
ZMP is changed without changing a floor reaction force 
vertical component and a floor reaction force horizontal 
component is referred to as the body inclination mode. 

A change in the floor reaction force moment 
horizontal component per unit angular acceleration at this 
time is denoted by AMr and a change in the floor reaction 
force horizontal component per unit angular acceleration 
is denoted by AFr. AFr is zero. If an angular 
acceleration of a body inclination angle is generated to 
cause the body 3 to lean forward in the situation shown in 
Fig. 9, then AMr acts in the direction of the arrow shown 
in Fig. 9. 

Further, if a body yaw angular acceleration (the 
rotational angular acceleration about the vertical axis of 
the body 3) is perturbated about a certain point Pq from a 
certain motion state of the robot 1, as shown in Fig. 10, 
then the angular momentum vertical component about the 
total center of gravity is perturbated, while the total 
center of gravity of the robot 1 remains unperturbated. 
Incidentally, if the total center of gravity of the robot 
1 is not perturbated, then the perturbation of the angular 



momentum vertical component does not depend on a point of 
action. Hence, perturbatlng the body yaw angular 
acceleration about the point Pq perturbates the floor 
reaction force moment vertical component about a desired 
ZMP without perturbatlng the floor reaction force vertical 
component, the floor reaction force horizontal component, 
and the floor reaction force moment horizontal component. 
The motion mode In which the body yaw angular acceleration 
of the robot 1 Is perturbated as described above Is 
referred to as the body yaw rotation mode. 

In other words, the body motion In which the floor 
reaction force moment vertical component about a desired 
ZMP Is changed without changing a floor reaction force 
vertical component, a floor reaction force horizontal 
component, and a floor reaction force moment horizontal 
component Is called the body yaw rotation mode. 

A change In the floor reaction force moment vertical 
component per unit angular acceleration at this time is 
denoted by AMbz, and a change in the floor reaction force 
horizontal component per unit angular acceleration is 
denoted by AFb. AFb is zero. If the body 3 is rotated in 
the direction of the arrow at the unit angular 
acceleration (rotated at an angular acceleration pb=l) in 
the situation shown in Fig. 10, then AMbz acts in the 
direction of the arrow shown in Fig. 10. 

In the motion shown in Fig. 10, the body 3 has been 
rotated so that the positions of the distal ends of both 



- 58 - 



arms 5^ 5 remain unchanged as observed from the supporting 
leg coordinate system (the coordinate system fixed to a 
floor). However, a motion In which an arm 5 Is rotated 
together with the body 3 without changing the relative 
position/posture of the arm 5 In relation to the body 3 
may be defined as the body yaw rotation mode. In this 
case, however, a motion equation to be discussed 
hereinafter has to be slightly changed. 

Further, If the distal ends of both arms 5, 5 are 
perturbated longitudinally In opposite directions from 
each other from a motion state of the robot 1, as 
Illustrated In Figs. 11 (a) and (b), then the angular 
momentum vertical component about the total center of 
gravity Is perturbated, while the total center of gravity 
of the robot 1 remains unperturbated. Hereinafter, this 
motion mode will be referred to as an antiphase arm swing 
mode. In other words, the arm swing motion mode In which 
the floor reaction force moment vertical component about a 
desired ZMP Is perturbated without perturbatlng a floor 
reaction force vertical component, a floor reaction force 
horizontal component, and a floor reaction force moment 
horizontal component Is referred to as the antiphase arm 
swing mode. 

A motion In which a right arm 5R Is moved forward by 
a unit amount and a left arm 5L Is moved backward by a 
unit amount Is referred to as an antiphase arm swing of a 
unit angle. Figs. 11 (a) and (b) Illustrate a state 
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wherein an antiphase arm swing angle Is Baz. 

A change In the floor reaction force moment vertical 
component per unit angular acceleration In the antiphase 
arm swing mode Is denoted by AMaz, and a change In the 
floor reaction force horizontal component per unit angular 
acceleration is denoted by AFa. AFa is zero. In the 
situation shown in Figs. 11 (a) and (b). If the right arm 
5R Is accelerated forward, while the left arm 5L Is 
accelerated backward (swinging at an angular acceleration 
pa>0), then a floor reaction force moment vertical 
component Maz acts in the direction of the arrow (a 
positive direction of the vertical axis) shown in Fig. 11 
(a). 

A description will now be given of a dynamic model of 
the robot 1 used in the present first reference example. 
In the present first reference example, a simplified 
(approximated) dynamic model shown below is used. However, 
regarding the dynamic model shown below, a kinematics 
model (a model representing the structures and dimensions 
of joints and links, i.e., a model representing a 
relationship between Joint displacements and the 
positions/postures of links) will be also necessary. 

Fig. 12 shows a dynamic model of the robot 1 used in 
the present first reference example. As illustrated, the 
dynamic model is a model composed of a total of three mass 
points, namely, two mass points 2m, 2m corresponding to 
the legs 2 of the robot 1 and a mass point 3m 
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corresponding to the body 3, and four flywheels FHx, FHy, 
FHbz, and FHaz having inertias but no mass. The flywheels 
FHx, FHy, FHbz, and FHaz can be rotated about an X-axis 
(longitudinal axis), a Y-axis (lateral axis), a Z-axis 
(vertical axis), and a Z-axis (vertical axis), 
respectively. This dynamic model is decoupled, that is, 
the dynamic model is constructed such that the dynamics 
(the dynamics of the mass points 2m, 2m) of the legs 2, 2, 
the dynamics of the body 3 (the dynamics of the mass point 
3m and the flywheels FHx, FHy and FHbz), and the dynamics 
of the arms 5, 5 (the dynamics of the flywheel FHaz) do 
not interfere with each other, and the dynamics of the 
entire robot 1 is represented by their linear connection. 
In addition, a relationship between a motion of the body 3 
and a floor reaction force is separated into a 
relationship between a translational motion of the body 3 
(body translation mode) and a floor reaction force, a 
relationship between an inclination motion of the body 3 
(body inclination mode) and a floor reaction force, a 
relationship between a yaw rotational motion of the body 3 
(body yaw rotation mode) and a floor reaction force, and a 
relationship between an antiphase arm swing motion of both 
arms 5, 5 (antiphase arm swing mode) and a floor reaction 
force. To be more specific, a floor reaction force 
generated by a horizontal motion of the body mass point 3m 
corresponds to a floor reaction force generated by a 
horizontal translational motion of the body 3 (body 
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translation mode), and a floor reaction force generated by 
a rotational motion of the flywheels FHx and FHy 
corresponds to a floor reaction force generated by a 
rotational motion of an inclination angle of the body 3 
(body inclination mode)* The rotational motion of the 
flywheel FHx corresponds to the rotational motion of an 
inclination angle of the body 3 in the roll direction 
(about the X-axis), and the rotational motion of the 
fljTwheel FHy corresponds to the rotational motion of an 
inclination angle of the body 3 in the pitch direction 
(about the y-axis). A floor reaction force generated by 
the rotational motion of the flywheel FHbz corresponds to 
a floor reaction force generated by a yaw rotational 
motion of the body 3 (the body yaw rotation mode). A 
floor reaction force generated by the rotational motion of 
the flywheel FHaz corresponds to a floor reaction force 
generated by an antiphase arm swing motion (the antiphase 
arm swing mode ) . 

The mass of the arms of the robot 1 is assumed to be 
included in the body 3, and the body mass point 3m has a 
mass that includes the mass of the arms 5, 5. 

For the convenience of explanation, variables and 
parameters related to the dynamic model will be defined as 
follows. Each of the mass points 2m, 2m and 3m 
corresponds to a representative point of a part with which 
it is associated or a point uniquely decided geometrically 
from the position/posture of the part. For instance, the 
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position of the mass point 2m of a supporting leg 2 Is 
defined as the point above the aforesaid representative 
point of the sole of the foot 22 of the leg 2 by a 
predetermined distance. 
5 Zsup: Supporting leg mass point vertical position 
Zswg: Free leg mass point vertical position 
Zb: Body mass point vertical position (usually different 
from a vertical body position) 

ZGtotal: Overall center-of -gravity vertical position 
10 Xsup: Supporting leg mass point X position 
Ysup: Supporting leg mass point Y position 
Xswg: Free leg mass point X position 
Yswg: Free leg mass point Y position 

Xb: Body mass point X position (The body mass point 
15 position is the position offset by a predetermined 

distance in the longitudinal direction of the body from 
the aforesaid point Pr. The offset is determined such 
that the center-of -gravity position of an exact model and 
the center- of -gravity position of the present dyncunlc 
20 model agree with each other as much as possible in an 
upright stance or the like. This is usually different 
from a horizontal body position.) 
Yb: Body mass point Y position 

XGtotal: Overall center-of -gravity horizontal X position 
25 YGtotal: Overall center-of -gravity horizontal Y position 
Obx: Body inclination angle about X-clxIs relative to 
vertical direction 
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eby: Body Inclination angle about Y-axls relative to 
vertical direction 
6bz: Body yaw rotational angle 
6az: Antiphase arm swing angle 
5 mb: Body mass point mass 

msup: Supporting leg mass point mass 
mswg: Free leg mass point mass 

mtotal: Total mass of robot (= mb + msup + mswg) 
J: Body inertial moment (Equivalent inertial moment in the 
10 body inclination mode. In other words, this is an 

inertial moment of FHx and FHy. Usually, it does not 
agree with the inertial moment of the body 3 part of the 
actual robot 1 . ) 

Jbz: Body inertial moment about a vertical axis 
15 (Equivalent inertial moment in the body yaw rotation mode. 

Usually, this does not agree with the inertial moment of 

the body 3 part of the actual robot 1 . ) 

Jaz: Arm swing inertial moment about a vertical axis 

(Equivalent inertial moment in antiphase arm swing to 
20 cancel a spin. In other words, it is an inertial moment 

of FHz . ) 

Fx: Floor reaction force X component (More specifically, a 
longitudinal (X-axis) component of a translational floor 
reaction force) 

25 Fy: Floor reaction force Y component (More specifically, a 
lateral (Y-axis) component of a translational floor 
reaction force) 
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Pz: Floor reaction force vertical component (More 
specifically, a vertical (Z-axls) component of a 
translatlonal floor reaction force. This Is equivalent to 
a desired translatlonal floor reaction force vertical 
5 component In the present first reference example.) 

Mx: X component of a floor reaction force moment about a 
desired ZMP (More specifically, a component about a 
longitudinal axis (X-axls) of a floor reaction force 
moment ) 

10 My: Y component of a floor reaction force moment about a 
desired ZMP (More specifically, a component about a 
lateral axis (Y-axls) of a floor reaction force moment) 
Mz: Z component of a floor reaction force moment about a 
desired ZMP (More specifically, a component about a 

15 vertical axis (Z-eixls) of a floor reaction force moment) 
An X position and a Y position of each of the mass 
points 2m and 3m mean a position In the longitudinal 
direction (X-axls direction) and a position In the lateral 
direction (Y-axls direction), respectively. In the 

20 present first reference example, a positional relationship 
between a position of the mass point 2m of each leg 2 and 
a position of the foot 22 of the leg 2 (a position of a 
predetermined representative point of the foot 22) Is 
determined In advance, so that If one of the positions Is 

25 decided, then the other position Is uniquely decided. 

Further, a positional relationship between the body mass 
point 3m and the position of the body 3 (a position of a 
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predetermined representative point of the body 3) Is 
determined In advance on the basis of a posture angle of 
the body 3 (hereinafter, regarding the body, a posture 
angle will mean an Inclination angle and a yaw angle), and 
5 If a position and a posture angle of one of them are 

determined, then the position of the other is uniquely 
determined. 

For an arbitrary variable X, dX/dt denotes first 
order differentiation of X, and d2X/dt2 denotes second 

10 order differentiation. Therefore, if the variable X 
denotes displacement, then dX/dt means velocity and 
d2X/dt2 means acceleration. g denotes a gravity 
acceleration constant. Here, g takes a positive value. 
A motional equation of the above dynamic model (an 

15 equation expressing a dynamic balance condition) is 

represented by equation 01, equation 02x, equation 02y, 
equation 03x, equation 03y, and equation 032. 

F2=mb* ( g+d2Zb/dt2 ) +msup« ( g+d2Zsup/dt 2 ) 
20 +mswg'i'(g+d2Zswg/dt2) Equation 01 

Fx=mb*d2Xb/dt2+msup*d2Xsup/dt2+mswg*d2Xswg/dt2 

Equation 02x 

25 Fy=mb*d2Yb/dt2+msup*d2Ysup/dt2+mswg*d2Yswg/dt2 

Equation 02y 
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Mx=mb* { Yb-Yzmp ) * ( g+d2Zb/dt 2 ) 
-mb* ( Zb- Zzmp ) * ( d2Yb/dt2 ) 
+insup* ( Ysup- Yzmp ) * ( g+d2Zsup/dt2 ) 
-msup* ( Zsup- Z zmp ) * ( d2Ysup/dt 2 ) 
+mswg* ( Yswg- Yzmp ) * ( g+d2Zswg/dt2 ) 
-mswg* ( Zswg- Zzmp ) * ( d2Yswg/dt 2 ) + J*d2ebx/dt2 

Equation 03x 

My= -mb* ( Xb-Xzmp ) * ( g+d2Zb/dt 2 ) 
+mb* ( Zb-Zzmp ) * ( d2Xb/dt2 ) 
-msup* ( Xsup-Xzmp ) » ( g+d2 Zsup/dt 2 ) 
+msup* { Zsup- Z zmp ) * ( d2Xsup/dt2 ) 
-mswg* (Xswg-Xzmp ) * ( g+d2Zswg/dt2 ) 
+mswg* ( Zswg-Zzmp) * ( d2Xswg/dt2 ) + J*d2eby/dt2 

Equation 03y 

Mz=mb* (Xb-Xzmp ) * ( d2Yb/dt2 ) -mb* ( Yb-Yzmp ) * ( d2Xb/dt 2 ) 
+msup* (Xsup-Xzmp ) * ( d2 Ysup/dt2 ) 
-msup* ( Ysup- Yzmp ) * ( d2Xsup/dt2 ) 
+mswg* ( Xswg-Xzmp ) * ( d2 Yswg/dt 2 ) 
-mswg* ( Yswg- Yzmp ) * ( d2Xswg/dt 2 ) 
+Jbz*d2ebz/dt2+Jaz*d2e az/dt2 

Equation 03 z 

Furthermore, for a total center- of -gravity position 
of the robot, the following relational expressions hold: 
ZGtotal=(mb*Zb+msup*Zsup+mswg*Zswg)/mtotal 
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Equation 04 

XGtotal= (inb*Xb+msup*Xsup+mswg*Xswg) /mtotal 

Equation 05x 

YGtotal= (mb*Yb+msup*Ysup+mswg*yswg) /mtotal 
5 Equation 05y 

The following will show a relationship between the 
above dynamic model and the above AFp, AMp, AFr, and AMr. 

The above AFp is a perturbation amount of Fx or Fy 
10 when d2Xb/dt2 or d2Yb/dt2 is perturbated by a unit amount 
in equation 02x or equation 02y, so that it is determined 
according to the following equation: 

AFp = mb ... Equation 06 

More specifically, the change AFp of a floor reaction 
15 force horizontal component per unit acceleration in the 

direction of each horizontal axis (X-axis, Y-sucis) in the 
body translation mode corresponds to the mass of the body 
mass point 3m of the dynamic model. 

The above AMp is a perturbation amount of My or Mx 
20 when d2Xb/dt2 or d2Yb/dt2 is perturbated by a unit amount 
in equation 03y or equation 03x, so that it is determined 
according to the following equation: 

AMp = mb*(Zb-Zzmp) ... Equation 07 

More specifically, the change AMp of a floor reaction 
25 force moment horizontal component per unit acceleration in 
the direction of each horizontal axis (X-axis, Y-axis) in 
the body translation mode is obtained by multiplying a 
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body mass point mass of the dynamic model by a height 
(vertical position) of the body mass point 3m from a 
desired ZMP. The relationship between the positions of 
the body mass point 3m and the desired ZMP and the motion 
of the body mass point 3m corresponds to the behavior of 
an Inverted pendulum obtained when the body mass point 3m 
Is associated with an Inverted pendulum mass point and 
when the desired ZMP is associated with an Inverted 
pendulum supporting point. To be more accurate, AMp in 
the Y-axls direction is obtained by reversing the sign of 
the right side of equation 07. 

The above AFr is a perturbation amount of Fx or Fy 
when d2eby/dt2 is perturbated by a unit amount in equation 
02x or equation 02y, so that it is determined according to 
the following equation: 

AFr = 0 Equation 08 

This means that the change AFr of a floor reaction 
force horizontal component per unit acceleration in the 
direction of each horizontal axis (X-axis, Y-axls) in the 
body Inclination mode is zero. 

The above AMr is a perturbation amount of Mx or My 
when d26bx/dt2 or d2eby/dt2 is perturbated by a unit 
amount in equation 03x or equation 03y, so that it is 
determined according to the following equation: 

AMr = J ... Equation 09 

More specifically, the change AMr of a floor reaction 
force moment horizontal component per unit acceleration in 
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the direction of each horizontal axis (X-axis, Y-axis) in 
the body inclination mode corresponds to the inertial 
moments of horizontal axis flywheels (FHx and Fhy) . 

The above AMbz is a perturbation amount of Mz when 
5 d26bz/dt2 is perturbated by a unit amount in equation 03z, 
so that it is determined according to the following 
equation: 

AMbz = Jbz ... Equation 09b 

More specifically, the change AMbz of a floor 
10 reaction force moment component per unit acceleration in 
the body yaw rotation mode corresponds to the inertial 
moment of a flywheel FHbz corresponding to body yaw 
rotation. 

The above AMaz is a perturbation amount of Mz when 
15 d2eaz/dt2 is perturbated by a unit amount in equation 03z, 

so that it is determined according to the following 

equation: 

AMaz = Jaz ... Equation 09a 

More specifically, the change AMaz of a floor 
20 reaction force moment component per unit angular 

acceleration of an antiphase arm swing corresponds to the 

inertial moment of a flywheel FHaz corresponding to an arm 

swing • 

The gait generating device 100 in the present first 
25 reference example generates a desired gait for one step in 
order, the one step for the desired gait (the desired gait 
in the narrow sense described above) being from the moment 



- 70 - 



one leg 2 of the robot 1 lands to the moment the other leg 
2 lands. Hence, for the running gait shown in Fig, 5 to 
be generated in the present first reference example, a 
desired gait from the beginning of a single stance period 
5 to the end of the following floating period (the beginning 
of the next single stance period) is generated in sequence. 
Here, a desired gait that is being newly generated will be 
referred to as a "current time gait," the next desired 
gait will be referred to as a "next gait," and a desired 

10 gait after next will be referred to as a "next but one 
time gait." Furthermore, a desired gait generated one 
step before the "current time gait" will be referred to as 
a "last time gait." 

When the gait generating device 100 newly generates a 

15 current time gait, expected positions /postures of landing 
of the foot 22 of a free leg and required values 
(requests) of expected landing time for the next two steps 
of the robot 1 are input as required parameters to the 
gait generating device 100 (or the gait generating device 

20 100 reads the required parameters from a memory) . Then, 
the gait generating device 100 uses these required 
parameters to generate a desired body position/posture 
trajectory, a desired foot position/posture trajectory, a 
desired ZMP trajectory, a desired floor reaction force 

25 vertical component trajectory, a desired arm posture 
trajectory, etc. At this time, some of the gait 
parameters specifying these trajectories are corrected, as 



necessary # to secure continuity of walking. 

Taking the generation of the running gait shown In 
Fig. 5 as an example, gait generation processing of the 
gait generating device 100 In the present first reference 
example will be explained In detail with reference to Fig. 
13 to Fig. 46. Fig. 13 Is a flowchart (structured 
flowchart) Illustrating a main routine of the gait 
generation processing carried out by the gait generating 
device 100. 

First, various Initializing operations. Including 
Initialization of time t to zero, are performed In SOIO. 
This processing Is Implemented primarily when starting up 
the gait generating device 100. Next, the processing 
proceeds to S014 via S012 and waits for a timer Interrupt 
for each control cycle (the calculation processing cycle 
of the flowchart shown In Fig. 13). The control cycle Is 
denoted by At . 

Then, the processing proceeds to S016 and determines 
whether a shift In a gait Is taking place. If a shift In 
the gait Is taking place, then the processing proceeds to 
S018, or If a shift In a gait Is not taking place, then It 
proceeds to S030. Here, "the shift In a gait" means a 
timing at which the generation of the last time gait has 
been completed and the generation of the current time gait 
Is about to start. For Instance, a control cycle 
following the control cycle In which the generation of a 
last time gait has been completed refers to the shift In a 
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gait. 

When proceeding to S018, time t is initialized to 
zero. The gait generating device 100 then proceeds to 
S020 and reads a next time's gait supporting leg 
coordinate system, a next but one time's gait supporting 
leg coordinate system, a current time gait cycle, and a 
next time gait cycle. These supporting leg coordinate 
systems and the gait cycles are determined by the above 
required parameters. More specifically, in the present 
first reference example, the required parameters supplied 
to the gait generating device 100 from the Joystick 73 or 
the like include required values of expected landing 
positions/postures (foot positions/postures in a state 
wherein the foot 22 has been rotated without slippage such 
that its sole is substantially in full contact with a 
floor surface after landing) and expected landing time of 
the foot 22 of a free leg for up to two steps ahead. The 
required value for the first step and the required value 
for the second step are supplied to the gait generating 
device 100 as the values associated with a current time 
gait and a next time gait, respectively, before the 
generation of the current time gait is begun (the shift in 
a gait in S016 mentioned above). These required values 
can be changed in the middle of generating the current 
time gait. 

Then, the next time's gait supporting leg coordinate 
system is determined on the basis of the required value of 
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the expected landing position/posture of the free leg foot 
22 of the first step (the free leg foot 22 in the current 
time gait) in the above required pareuneters. 

Referring to, for example. Fig. 16, it is assumed 
that the required value for an expected landing 
position/posture of the free leg foot 22 (22L in the 
figure) related to the current time gait (first step) 
specifies a position/posture obtained by moving by xnext 
and ynext in the X-axis direction (in the longitudinal 
direction of a supporting leg foot 22R of the current time 
gait) and in the Y-axis direction (in the lateral 
direction of the supporting leg foot 22R of the current 
time gait), respectively, of a current time's gait 
supporting leg coordinate system, and by rotating about 
the Z-axis (about the vertical axis) by Bznext with 
respect to a landing position/posture of the supporting 
leg foot 22 (22R in the figure) of the current time gait. 
Here, the supporting leg coordinate system is a global 
coordinate system (a coordinate system fixed to a floor) 
in which a point, at which a perpendicular line extended 
onto a floor surface from the center of the ankle of a 
supporting leg foot 2 intersects with the floor surface 
(this point agreeing with a representative point of the 
foot 22 in a state, wherein substantially the entire 
surface of the sole of the supporting leg foot 22 is in 
contact with the floor surface in the present reference 
example), in a state wherein the supporting leg foot 22 is 
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set In a horizontal posture (more generally, a posture 
parallel to the floor surface) and substantially the 
entire surface of the sole of the supporting leg foot 22 
is in contact (in close contact) with the floor surface, 
is defined as an origin thereof, and a horizontal plane 
passing the origin is defined as an XY plane. In this 
case, the X-axis direction and the Y-axis direction 
correspond to the longitudinal direction and the lateral 
direction, respectively, of the supporting leg foot 22, 
The origin of the supporting leg coordinate system does 
not have to agree with the representative point of the 
foot 22 (a point representing the position of the foot 22) 
in the state wherein substantially the entire surface of 
the sole of the supporting leg foot 22 is in contact with 
the floor surface. Alternatively, the origin may be set 
at a point on the floor surface that is different from the 
representative point. 

At this time, the next time's gait supporting leg 
coordinate system is a coordinate system that takes, as 
its origin, the representative point (more specifically, a 
point on a floor that agrees with the representative 
point) of the foot 22L in a case where the foot 22 is 
landed according to a required value of the expected 
landing position/posture of the free leg foot 22L of the 
current time gait as illustrated (in a case where the 
representative point of the foot 22 is made to agree with 
the required value of an expected landing position and the 
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posture (orientation) of the foot 22 is made to agree with 
the required value of an expected landing posture) . The 
longitudinal direction and the lateral direction of the 
foot 22L in the horizontal plane passing the origin 
5 correspond to an X'-axis direction and Y'-clxIs direction, 
respectively . 

In the same manner described above, a next but one 
time's gait supporting leg coordinate system (refer to the 
X" Y" coordinates shown in Fig. 16) is determined on the 

10 basis of the required values for the expected landing 
position/posture of the free leg foot 22 of the second 
step. A current time gait cycle is determined as the 
duration from the expected landing time (required value) 
of the supporting leg foot 22 of the current time gait to 

15 the expected landing time (required value) of the free leg 
foot 22 of the first step (current time gait). The next 
time gait cycle is determined as the duration from the 
expected landing time (required value) of the free leg 
foot 22 of the first step to the expected landing time 

20 (required value) of the free leg foot 22 of the second 
step. 

The required parameters are input to the gait 
generating device 100 by necessary operation of the 
joystick 73 in the present first reference example. 
25 Alternatively, however, the required parameters or the 
positions /postures and gait cycles of the aforesaid 
supporting leg coordinate systems associated with the 
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required parameters may be stored in advance as a travel 
schedule of the robot 1. Alternatively, the aforesaid 
next time's and the next but one time's gait supporting 
leg coordinate systems and the current time and the next 
time gait cycles may be determined on the basis of 
commands (requests) from a manipulation device, such as 
the joystick 73, and a travel history of the robot 1 up to 
that moment. 

Subsequently, the processing proceeds to S022 wherein 
the gait generating device 100 determines gait parameters 
of a normal turning gait as a virtual cyclic gait that 
follows the current time gait. The gait parameters 
include a foot trajectory parameter defining a desired 
foot position/posture trajectory, a reference body posture 
trajectory parameter defining a body posture trajectory to 
be based on, a reference arm posture trajectory parameter 
defining an arm posture trajectory to be based on, a ZMP 
trajectory parameter defining a desired ZMP trajectory, 
and a floor reaction force vertical component trajectory 
parameter defining a desired floor reaction force vertical 
component trajectory in the normal turning gait. 
Furthermore, parameters that define a floor reaction force 
horizontal component permissible range and a floor 
reaction force moment vertical component permissible range 
are also included in gait parameters. 

In the present description, "the normal turning gait" 
is used to mean a cyclic gait that does not cause 
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discontinuity in motional states (states of foot 
position/posture, body position/posture, etc.) of the 
robot 1 in a boundary of gait when the gait is repeated 
(the boundary of a gait for each step in the present first 
5 reference example). Hereinafter, *the normal turning 
gait" may be abbreviated as "the normal gait." 

According to the present first reference example, the 
normal turning gait, which is a cyclic gait, may be 
defined as follows. A gait for two steps of the robot 1, 

10 i.e., a gait composed of a first turning gait following a 
current time gait and a second turning gait following the 
first turning gait, is defined as the gait for one cycle 
of the normal turning gait, and the normal turning gait 
consists of a repetition of the gait for one cycle. The 

15 term "turning" is used here, because it would mean 

straight advancement when the turning rate is set to zero, 
and straight advancement can be also included in turning 
in a broad sense. If a desired gait to be generated is 
the running gait shown in Fig. 5, then a current time gait 

20 of the desired gait is a running gait that has a single 
stance period and a floating period. Hence, the first 
turning gait and the second turning gait of the normal 
turning gait are both gaits that also have a single stance 
period and a floating period, as in the current time gait. 

25 In other words, a basic gait form of the first turning 
gait and the second turning gait is the same as that of 
the current time gait. 
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Supplemental explanation of the normal turning gait 
will be added. In a bipedal mobile robot, the normal 
turning gait for one cycle requires gaits in the aforesaid 
narrow sense for at least two steps. It is further 
5 possible to set a complicated normal turning gait composed 
of gaits of three steps or more as the gaits for one cycle. 
The normal turning gait, however, is used only to 
determine a divergent component (to be discussed in detail 
hereinafter) at the end (finish time) of the current time 

10 gait. Therefore, using the normal turning gait composed 
of the gaits of three or more steps for one cycle will 
provide less effect, while the complicated processing for 
generating the gait is involved. For this reason, the 
gaits for one cycle in the normal turning gait in the 

15 present first reference example include gaits for two 
steps (the first and the second turning gaits). For a 
legged mobile robot having three or more feet, the number 
of gaits for defining the normal turning gait will 
increase accordingly. In the following description, for 

20 the convenience of explanation, the normal turning gait 

composed of a plurality of gaits in the narrow sense (the 
gaits for two steps in the present first reference 
example) will be regarded as the gait of one step. 

A normal turning gait is prepared for provisional use 

25 by the gait generating device 100 to determine motional 

states of the robot 1, including a divergent component or 
a vertical body posit ion/ velocity , and a body posture 
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angle and an angular velocity thereof at the end of a 
current time gait; it is not directly output from the gait 
generating device 100. 

The term "divergent" means that the position of the 
5 body 3 of the bipedal mobile robot 1 is undesirably 

shifted to a position away from the positions of both feet 
22 and 22, as shown in Fig. 14. The value of a divergent 
component is a numeral value indicating how far the 
position of the body 3 of the bipedal mobile robot 1 is 

10 away from the positions of both feet 22 and 22 (to be more 
specific, the origin of a global coordinate system (a 
supporting leg coordinate system) set on the surface with 
which a supporting leg foot 22 is in contact). 

In the present first reference excunple, gaits are 

15 generated using a divergent component as an indicator so 
that a desired gait can be continuously generated without 
causing the divergence. However, even if it is an initial 
divergent component (divergent component at initial time 
of the normal turning gait) of a normal gait, which is a 

20 typical example of a continuous gait (a cyclic gait that 
permits repetition of a gait of the same pattern without 
causing discontinuity of a gait trajectory, and that does 
not theoretically diverge after an infinite number of 
repetitions ) , the initial divergent component is not 

25 simply zero. The initial divergent component changes if a 
parameter of a normal gait changes. In other words, a 
proper divergent component changes according to a gait 
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form, such as the manner of walking or the manner of 
running, or the like. In the present first reference 
example, therefore, a normal gait following a current time 
gait to be generated Is set on the basis of required 
parameters Involved In the current time gait, and the 
Initial divergent component of the normal gait Is 
determined, and then a current time gait Is generated such 
that the divergent component at the end of the current 
time gait agrees with the Initial divergent component of 
the normal gait (more generally, the current time gait Is 
made to continue or approximate to the normal gait). The 
basic guideline for generating such gaits Is the same as 
that disclosed In PCT Kokal publication WO/02/40224 
previously proposed by the present applicant. 

The first reference example of the present Invention 
does not use a linear dynamic model with three mass points 
used In the first embodiment of PCT Kokal publication 
WO/02/40224. Nevertheless, the concept of the divergent 
component and the convergent component defined by the 
equation given below can be applied with adequate 
approximate accuracy to a perturbation of a behavior of a 
nonlinear dynamic model such as the one shown In Fig. 12. 

Divergent component = Body mass point horizontal 
position + Body mass point horizontal velocity / ioO 

... Equation 10 

Convergent component = Body mass point horizontal 
position - Body mass point horizontal velocity / coO ' 
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Equation 11 

where the body mass point horizontal position in this 
case indicates a body mass point horizontal position Xb in 
the dynamic model shown in Fig. 12. 
5 coO and coO ' take predetermined values . The values of 

these coO and coO ' are substantially the same, although they 
do not exactly coincide. Further, the values for 
generating walking gaits in PCT Kokai publication 
WO/ 02/ 4 02 2 4 must be slightly changed for running. 

10 More details of the divergent component and the 

convergent component have been given in PCT Kokai 
publication WO/02/40224, so that no more description will 
be given here. 

In the present first reference example, in addition 

15 to the method disclosed in PCT Kokai publication 

WO/02/40224, a gait parameter defining a desired floor 
reaction force vertical component trajectory is set, and a 
total center -of -gravity vertical position of the robot 1 
is determined so as to dynamically satisfy the desired 

20 floor reaction force vertical component, as will be 
discussed hereinafter. In this case, a second order 
Integrated value of the floor reaction force vertical 
component will define the total center- of -gravity vertical 
position of the robot 1. Hence, if the desired floor 

25 reaction force vertical component is improperly set, then 
the total center-of -gravity vertical position or the 
vertical body position of the robot 1 will be too high or 
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too low. Therefore, the method for setting a desired 
floor reaction force vertical component Is also an 
Important issue. However, the relationship between a 
floor reaction force vertical component and a vertical 
5 body position Is similar to the relationship between ZMP 
and a horizontal body position, so that a technique for 
determining a desired ZMP for setting a proper horizontal 
body position/velocity can be applied to the technique for 
determining a desired floor reaction force vertical 
10 component for setting a proper vertical body 

position/velocity simply by slightly changing a part 
thereof, as shown In the following present first reference 
example • 

Returning to the main subject, in S022, the 
15 processing below is carried out according to the flowchart 
shown in Fig. 15. 

First, in SlOO, a foot trajectory parameter among the 
gait parameters of a normal gait is determined to provide 
a foot position/posture trajectory composed of a current 
20 time gait, a first turning gait, and a second turning gait 
in succession in this order. The following will explain a 
specific setting method with reference to Fig. 16. In the 
following explanation, the foot 22 of a supporting leg 2 
will be referred to as the supporting leg foot and the 
25 foot 22 of a free leg 2 will be referred to as the free 

leg foot. Further, "start" and "end" will mean start time 
and end time of a gait or instantaneous gaits at the start 



- 83 - 



time and the end time. 

The foot trajectory parameter Is constructed 
primarily of the positions/postures of a supporting leg 
foot and a free leg foot, respectively, at the start and 
the end, respectively, of a first turning gait and a 
second turning gait, and a gait cycle of each turning gait. 
In the foot trajectory parameter, the free leg foot 
position/posture at the start of the first turning gait Is 
defined as the supporting leg foot position/posture at the 
end of a current time gait observed from a next time's 
gait supporting leg coordinate system. In this case, in a 
running gait, the supporting leg foot 22 at the end of the 
current time gait is moving in the air. And the 
supporting leg foot position/posture at the end of the 
current time gait is determined by generating a required 
value of an expected landing position/posture of the free 
leg foot 22 of a second step in the required parameter (a 
required value of an expected landing position/posture in 
a next time gait of the supporting leg foot 22 of the 
current time gait) or a foot position/posture trajectory 
for reaching a free leg position/posture at the end of the 
next time gait determined on the basis of a next but one 
time's gait supporting leg coordinate system that 
corresponds to the above required value (more specifically, 
the trajectory observed from a next time's gait supporting 
leg coordinate system) from the supporting leg foot 
position/posture at the start of the current time gait (= 
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the free leg foot position/posture at the end of the last 
time gait) by using the finite -duration setting filter 
until the end of the current time gait. 

The free leg foot position/posture at the end of the 
5 next time gait is determined such that the 

position/posture of the foot, which is obtained when the 
foot 22 is turned from that position/posture by a 
predetermined angle in the pitch direction until it 
reaches a horizontal posture by lowering its tiptoe while 

10 holding the foot 22 in contact with the ground, agrees 

with the position/posture in the next but one time's gait 
supporting leg coordinate system. In other words, the 
free leg foot position/posture at the end of the next time 
gait is the position/posture of the foot 22 in a state 

15 wherein the foot 22 has been turned, from a required value 
of the landing position/posture of the free leg foot 22 of 
the second step in the required parameter, by a 
predetermined angle in the pitch direction by lifting its 
tiptoe while holding the foot 22 in contact with the 

20 ground so that it does not slip (a state wherein the heel 
has been landed with the tiptoe raised) . 

Further, the supporting leg foot position/posture at 
the start of the first turning gait is defined as the free 
leg foot position/posture at the end of the current time 

25 gait observed from the next time's gait supporting leg 
coordinate system. In this case, the free leg foot 
position/posture at the end of the current time gait is 
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determined on the basis of the above next time's gait 
supporting leg coordinate system or a required value of an 
expected landing position/posture of the free leg of the 
first step (the current time gait) of the required 
5 parameter corresponding thereto, as In the case of the 

free leg foot position/posture at the end of the next time 
gait. In other words, the free leg foot position/posture 
at the end of the current time gait Is determined such 
that a representative point of the foot, which Is obtained 

10 when substantially entire surface of the sole of the foot 
22 Is brought Into contact with a floor surface by turning 
the foot 22 from the position/posture so as to lower Its 
tiptoe while holding the foot 22 In contact with the 
ground, agrees with the origin of the next time's gait 

15 supporting leg coordinate system. 

The free leg foot position/posture at the end of the 
first turning gait is determined on the basis of a 
position/posture on the next but one time's gait 
supporting leg coordinate system observed from the next 

20 time's gait supporting leg coordinate system, as with the 
technique for determining the free leg foot 
position/posture at the end of the current time gait or 
the free leg foot position/posture at the end of the next 
time gait. To be more specific, the free leg foot 

25 position/posture at the end of the first turning gait is 
set such that the position/posture of the foot, which is 
obtained when the foot 22 is turned from that 
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position/posture by a predetermined angle until it reaches 
a horizontal posture while avoiding a slippage and while 
holding the foot 22 in contact with the ground^ agrees 
with the position/posture in the next but one time's gait 
5 supporting leg coordinate system as observed from the next 
time's gait supporting leg coordinate system. 

At the end of the first turning gait, the supporting 
leg foot 22 is in the air, being off the floor. To 
determine the trajectory after the supporting leg foot 22 

10 leaves the floor, an expected landing position/posture of 
the supporting leg foot of the first turning gait is set. 
The expected landing position/posture of the supporting 
leg foot of the first turning gait is set on the basis of 
a position/posture on a next but two time's gait 

15 supporting leg coordinate system observed from the next 

time's gait supporting leg coordinate system. To be more 
specific, the expected landing position/posture of the 
supporting leg foot of the first turning gait is the 
position/posture on the next but two time's gait 

20 supporting leg coordinate system observed from the next 
time's gait supporting leg coordinate system. The next 
but two time's gait supporting leg coordinate system is 
set such that the relative position/posture relationship 
between the next but one time's gait supporting leg 

25 coordinate system and the next but two time's gait 

supporting leg coordinate system agrees with the relative 
position/posture relationship between the current time's 
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gait supporting leg coordinate system and the next time's 
gait supporting leg coordinate system - 

The supporting leg foot position/posture at the end 
of the first turning gait Is determined by generating a 
5 foot position/posture trajectory for reaching the expected 
landing position/posture of the supporting leg foot of the 
first turning gait from the supporting leg foot 
position/posture at the start of the first turning gait 
(more specifically, the trajectory observed from a next 
10 time's gait supporting leg coordinate system) by using the 
finite -duration setting filter until the end of the first 
turning gait, as In the case where the supporting leg foot 
position/posture at the start of the first turning gait Is 
determined, 

15 The free leg foot position/posture at the start of 

the second turning gait Is regarded as the supporting leg 
foot position/posture at the end of the first turning gait 
observed from the next but one time's gait supporting leg 
coordinate system. The supporting leg foot 

20 position/posture at the start of the second turning gait 
Is regarded as the free leg foot position/posture at the 
end of the first turning gait observed from the next but 
one time's gait supporting leg coordinate system. 

The free leg foot position/posture at the end of the 

25 second turning gait Is regarded as the free leg foot 
position/posture at the end of the current time gait 
observed from the current time's gait supporting leg 
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coordinate system. The supporting leg foot 
position/posture at the end of the second turning gait Is 
regarded as the supporting leg foot position/posture at 
the end of the current time gait observed from the current 
time's gait supporting leg coordinate system. 

The gait cycles of the first turning gait and the 
second turning gait are set to be Identical to a next time 
gait cycle. These gait cycles of the first turning gait 
and the second turning gait do not have to be the same 
with each other; however, both cycles are preferably 
determined on the basis of at least a next time gait cycle. 
Motion parameters (Including a time parameter, such as 
double stance period duration) other than the current time 
gait, the first turning gait, and the second turning gait 
are determined, as necessary, so as to satisfy gait 
conditions (such as an actuator velocity falling within a 
permissible range, a movable angle being not exceeded, and 
no Interference with a floor or the like) on the basis of 
the parameters determined above. 

Next, the processing proceeds to S102 and determines 
a reference body posture trajectory parameter that defines 
the reference body posture trajectory to be followed by a 
desired body posture. The reference body posture does not 
have to be constant as long as it is set to ensure 
connection at the start (the start of the first turning 
gait) and the end (the end of the second turning gait) of 
a normal gait (to ensure that the posture angle of the 
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reference body posture and the angular velocity thereof at 
the start of a normal gait agrees with those at the end of 
the normal gait). In the present first reference excunple, 
however, for the purpose of easy understanding, a posture 
5 related to an inclination angle (an inclination angle 

relative to the vertical direction) in the reference body 
posture is set to an upright posture (vertical posture). 
This means that, in the present first reference example, 
the reference body posture related to an inclination angle 

10 of the body 3 is set to the upright posture in all periods 
of the normal gait. Accordingly, in the present first 
reference example, the angular velocity and angular 
acceleration of an inclination angle of the reference body 
posture is zero. A yaw angle trajectory (hereinafter 

15 referred to also as a reference yaw angle trajectory) 6bz 
of the reference body posture may be, for example, a 
motion at a constant angular velocity (an average turning 
velocity of a normal gait), or may take a sinusoidal wave 
shape, as in the example (Fig. 18) of a reference 

20 antiphase arm swing trajectory, which will be discussed 
hereinafter. However, the yaw angle trajectory is to be 
set such that a reference yaw angle and its angular 
velocity are in succession when the normal gait is 
repeated. 

25 In the present first reference example, the yaw angle 

trajectory (hereinafter referred to also as a desired yaw 
angle trajectory) of a desired body posture is set to 
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agree with a reference yaw angle trajectory. 

Subsequently, the processing proceeds to S104 to 
determine reference arm posture trajectory parameters. To 
be more specific, pareuneters related to a total center-of- 
5 gravity position of both arms 5, 5 (a relative center-of- 
gravity position with respect to the body 3), a lateral 
interval between right and left hands (the distal ends of 
both arms 5 , 5 ) , and an antiphase arm swing angle are 
determined. For turning, for example, to the left as 

10 shown in Fig. 17, the reference antiphase arm swing angle 

may be set as shown in Fig. 18. As illustrated in Fig. 18, 
a reference antiphase arm swing angle Bazref is set such 
that, when a normal gait is repeated, an antiphase arm 
swing angle and an angular velocity will be both 

15 continuous at a boundary of gaits (the boundary between 
the end of a second turning gait and the next first 
turning gait) and the relative relationship between the 
supporting leg and an antiphase arm swing angle at the 
start of the first turning gait agrees with the relative 

20 relationship between the supporting leg and an antiphase 
arm swing angle at the start of the next first turning 
gait. In other words, the antiphase arm swing angular 
velocity at the start of the first turning gait and the 
antiphase arm swing angular velocity at the end of the 

25 second turning gait agree with each other, and the 

antiphase arm swing angle at the end of the second turning 
gait is set to a value obtained by adding the antiphase 
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arm swing angle at the start of the first turning gait to 
the turning angle of the normal gait (the sum of the 
turning angles of the first turning gait and the second 
turning gait). In Fig, 18, the reference antiphase arm 
5 swing angle Bazref has the sinusoidal waveform; however, 

it may alternatively be set to a constant angular velocity, 
or it may take an average value of a supporting leg yaw 
angle and a free leg yaw angle. 

In the present first reference example, the total 

10 center-of -gravity position of both arms 5, 5 of the 

desired arm posture (the relative position with respective 
to the body 3) is set to be maintained constant with 
respect to the body 3. 

Next, the processing proceeds to S106 and sets a 

15 floor reaction force vertical component trajectory 
parameter. In this case, the floor reaction force 
vertical component trajectory parameter is set such that 
the floor reaction force vertical component trajectory 
defined by the parameter is virtually continuous (values 

20 do not jump in steps), as shown in Fig. 6, in both the 

first turning gait and the second turning gait. In other 
words, a desired floor reaction force vertical component 
trajectory of the normal turning gait is set to have the 
pattern shown in Fig. 19. According to the pattern, for 

25 both the first turning gait and the second turning gait, 
the floor reaction force vertical component exhibits a 
trapezoidal change in a single stance period, and the 
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floor reaction force vertical component Is maintained at 
zero In a floating period. The time of break points of 
the pattern and the height of a trapezoid (peak value) are 
set as the floor reaction force vertical component 
5 trajectory parameters. 

When setting the floor reaction force vertical 
component trajectory parameters, an average value 
throughout a gait period of the floor reaction force 
vertical component (the period equivalent to the sum of 

10 the periods of the first turning gait and the second 

turning gait, that Is, the period equivalent to one cycle 
of a normal gait) Is made to agree with the self weight of 
the robot 1. This means that the average value of the 
floor reaction force vertical component Is set so that it 

15 provides the same magnitude as that of the gravity acting 
on the robot 1 but In an opposite direction. 

Setting the floor reaction force vertical component 
trajectory as described above is necessary to satisfy a 
normal gait condition. The normal gait conditions is such 

20 that a beginning state (a beginning state of a first 
turning gait) of any state variables (a position, a 
posture, a velocity, etc. of each part of the robot 1) of 
a gait observed from a supporting leg coordinate system (a 
coordinate system set on a plane with which the supporting 

25 leg foot 22 is in contact) and a terminal state (a 
terminal state of a second turning gait) of a gait 
observed from the next supporting leg coordinate system 



- 93 - 



(the supporting leg coordinate system of the next first 
turning gait) agree with each other (hereinafter, this 
condition may be referred to as a boundary condition of a 
normal gait). Therefore, the difference between a total 
5 center- of -gravity vertical velocity of the robot 1 at the 
end of the normal gait and a total center -of -gravity 
vertical velocity at the start of the normal gait (more 
specifically, the difference between the total center-of- 
gravlty vertical velocity at the end of a second turning 

10 gait and the total center- of- gravity vertical velocity at 
the start of the first turning gait) must be also zero. 
The difference Is an Integrated value of the difference 
between the floor reaction force vertical component and 
gravity (first order Integrated value); therefore, the 

15 floor reaction force vertical component trajectory must be 
set as described above In order to set the difference to 
zero. 

In the present first reference example, the average 
value of the floor reaction force vertical component In 

20 the period of each of the first turning gait and the 

second turning gait has been made to agree with the self 
weight of the robot 1. More specifically, the time of the 
break points of the trapezoidal portions of the floor 
reaction force vertical component trajectory In each 

25 turning gait has been set based on, for example, the gait 
cycle of the first turning gait and the second turning 
gait, and then the heights of the trapezoidal portions 
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have been determined such that the average value of the 
floor reaction force vertical component in the period of 
each of the first turning gait and the second turning gait 
agrees with the self weight of the robot 1 (the heights of 
5 the trapezoids are determined by solving an equation 

representing the condition under which the average value 
and the self weight coincide, taking the heights of the 
trapezoids as unknown ntimbers ) • 

Thus, the difference between the total center-of- 
10 gravity vertical velocity at the end of the first turning 
gait and the total center -of -gravity vertical velocity at 
the start of the first turning gait will be zero, and the 
difference between the total center -of -gravity vertical 
velocity at the end of the second turning gait and the 
15 total center-of -gravity vertical velocity at the start of 
the second turning gait will be also zero. This, however, 
is not a must* If, for instance, a vertical body position 
becomes excessively high or low at about a boundary of the 
first turning gait and the second turning gait, leading to 
20 a likelihood of an unreasonable posture, then the heights 
or the like of trapezoids of the floor reaction force 
vertical component trajectory of each turning gait may be 
corrected in the state in which the average value and the 
self weight agree in each turning gait. 
25 Next, the processing proceeds to S108 to set a 

permissible range of a floor reaction force horizontal 
component [Fxmin, Fxmax] (more specifically, a parameter 
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defining it), as shown in Fig. 20, on the basis of the 
floor reaction force vertical component trajectory set as 
shown in Fig. 19, as described above. The polygonal line 
on the negative side in Fig. 20 Indicates the permissible 
5 lower limit value Fxmin of the floor reaction force 

horizontal component, while the polygonal line on the 
positive side indicates the permissible upper limit value 
Fxmax of the floor reaction force horizontal component. A 
supplemental description will be given of a method for 

10 setting them. The following will explain a case where a 
floor surface is horizontal. 

The floor reaction force horizontal component is 
generated from friction between a floor and a foot 22. 
The friction cannot be generated limitlessly; it has a 

15 limit. Hence, the floor reaction force horizontal 

component of a desired gait has to be always within a 
friction limit in order to prevent the robot 1 from 
slipping when the actual robot 1 moves according to a 
generated desired gait. To meet this condition, a 

20 permissible range of the floor reaction force horizontal 
component will be set, and a desired gait will be 
generated such that the floor reaction force horizontal 
component of the desired gait falls within the permissible 
range, as it will be discussed hereinafter. 

25 When the coefficient of friction between the floor 

and the foot 22 is denoted by (x, Fxmin must be always set 
to be not less than -(x * floor reaction force vertical 
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component, and Fxmax must be set to be not more than [i * 
floor reaction force vertical component. A simplest 
setting method Is to set them according to the following 
expression. In which ka Is a positive constant that Is 
smaller than 1. 

Fxmln = -ka * * Floor reaction force vertical component 
Fxmax = ka * ji * Floor reaction force vertical component 

... Equation 12 

The permissible range of the floor reaction force 
horizontal component shown in Fig. 20 is an example set 
according to Equation 12. The values and time at the 
break points of the trapezoidal waveforms or the like in 
Fig. 20 may be set as the parameters for defining the 
pennlssible range of the floor reaction force horizontal 
component. Alternatively, however, if the permissible 
range of the floor reaction force horizontal component is 
determined according to Equation 12, then the value of 
(ka*M.) in Equation 12 may be simply set as a parameter. 

As long as the above condition (the condition in that 
the floor reaction force horizontal component of a desired 
gait always falls within a frlctlonal limit) is satisfied, 
a different setting method may be used to set the 
permissible range of the floor reaction force horizontal 
component . 

The sequence then proceeds to S109 and sets the 
permissible range [Mzmin, Mzmax] (more specifically, a 
parameter defining it) of a floor reaction force moment 
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vertical component, as shown In Fig. 21, on the basis of 
the floor reaction force vertical component trajectory or 
the like set as shown in Fig. 19, as described above. The 
polygonal line on the negative side in Fig. 21 indicates 
the permissible lower limit value Mzmin of the floor 
reaction force moment vertical component, while the 
polygonal line on the positive side indicates the 
permissible upper limit value Mzmax of the floor reaction 
force moment vertical component . A supplemental 
description will be given of a method for setting them. 
The following will explain a case where a floor surface is 
horizontal. 

The floor reaction force moment vertical component is 
generated from friction between a floor and a foot 22. 
The friction cannot be generated limitlessly; it has a 
limit. Hence, the floor reaction force moment vertical 
component of a desired gait has to be always within a 
friction limit in order to prevent the robot 1 from 
spinning when the actual robot 1 moves according to a 
generated desired gait. To meet this condition, a 
permissible range of the floor reaction force moment 
vertical component will be set, and a desired gait will be 
generated such that the floor reaction force moment 
vertical component of the desired gait falls within the 
permissible range, as it will be discussed hereinafter. 

If the coefficient of friction between the floor and 
the foot 22 is denoted by [x, and an effective radius of 
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the surface of contact between the floor and the foot 22 
to generate a moment vertical component (or a square root 
of a sectional secondary moment about a desired ZMP of the 
surface of contact between the floor and the foot 22) is 
5 denote by r, then Mzmin must be always set to be not less 
than -[X * r * floor reaction force vertical component^ and 
Mzmax must be set to be not more than * r * floor 
reaction force vertical component. A simplest setting 
method is to set them according to the following 
10 expression, in which ka is a positive constant that is 
smaller than 1 . 

Mzxmin = -ka * * r * Floor reaction force vertical 
component 

Mzmax = ka * * r * Floor reaction force vertical 
15 component 

• Equation 1012 

The permissible range of the floor reaction force 
moment vertical component shown in Fig. 21 is an example 
set according to Equation 1012. The values and time at 

20 the break points of the trapezoidal waveforms or the like 
in Fig. 21 may be set as the parameters for defining the 
permissible range of the floor reaction force moment 
vertical component. Alternatively, however, if the 
permissible range of the floor reaction force moment 

25 vertical component is determined according to Equation 
1012, then the value of (ka*|Ji) in Equation 1012 may be 
simply set as a parameter. r is desirably calculated from 
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a desired ZMP and a contact surface at each instant; 
alternately, however, r may be a constant. 

As long as the above condition (the condition in that 
the floor reaction force moment vertical component of a 
5 desired gait always falls within a frictional limit) is 
satisfied, a different setting method may be used to set 
the permissible range of the floor reaction force moment 
vertical component. 

Further alternatively, a permissible range may be set 

10 by combining a floor reaction force horizontal component 
and a floor reaction force vertical component moment 
rather than independently setting the permissible range of 
a floor reaction force horizontal component and the 
permissible range of a floor reaction force moment 

15 vertical component. This is because the permissible range 
of a floor reaction force moment vertical component 
becomes narrower as a floor reaction force horizontal 
component increases , while the permissible range of the 
floor reaction force horizontal component becomes narrower 

20 as the floor reaction force moment vertical component 
increases . 

Next, the processing proceeds to SllO and sets ZMP 
trajectory parameters defining the ZMP trajectoiry of the 
normal gait that combines the first turning gait and the 
25 second turning gait. In this case, a desired ZMP 

trajectory is set so as to exhibit a high stability margin 
and no sudden changes, as described above. 
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To be more specific, according to the running gait 
shown In Fig, 5, a few moments after the heel of the 
supporting leg foot 22 lands, substantially the entire 
surface of the sole of the supporting leg foot 22 comes In 
5 contact with the ground, and then, following a few moments, 
only the tiptoe of the supporting leg foot 22 comes in 
contact with the ground. Thereafter, the robot 1 kicks 
the ground with the tiptoe of the supporting leg foot 22 
to jump into the air. Lastly, the robot 1 lands at the 

10 heel of the free leg foot 22. The desired ZMP has to 

exist within a ground contact plane. In the present first 
reference example, therefore, the position of the desired 
ZMP in the X-axis direction for the first turning gait and 
the second turning gait of the normal gait is set so that 

15 it takes the heel of the supporting leg foot 22 as its 
initial position and stays at this position until 
substantially the entire sole of the foot 22 comes in 
contact with the ground, as illustrated in the upper 
diagram of Fig. 7 described above. Subsequently, the 

20 desired ZMP is set so that it moves to the center of the 
supporting leg foot 22, and then moves to the tiptoe by 
the time the tiptoe of the foot 22 comes in contact with 
the ground and remains thereafter at the tiptoe of the 
supporting leg foot 22 until the foot 22 leaves the floor. 

25 After that, the desired ZMP is set such that the desired 
ZMP continuously moves from the tiptoe of the supporting 
leg foot 22 to the landing position of the heel of the 
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free leg foot 22 by the time the next free leg foot 22 
lands, as previously described. Thus, the desired ZMP 
trajectory (the trajectory in the X-axis direction) of the 
normal gait composed of the first turning gait and the 
second turning gait will be as illustrated in Fig. 22. 
The time and positions of the break points of the desired 
ZMP trajectory are set as the ZMP trajectory parameters. 
In this case, the time of the break points is set on the 
basis of gait cycles of the first turning gait and the 
second turning gait determined based on the required 
parameters. The positions of the break points are set on 
the basis of the positions/postures on the next time's 
gait supporting leg coordinate system and the next but one 
time's gait supporting leg coordinate system or on the 
basis of the required values of the expected free leg foot 
landing positions/postures of the first step and the 
second step of the required parameters that define these 
coordinate systems. The position of the ZMP trajectory in 
the Y-e«is direction is set in the same manner as that 
illustrated in the lower diagram of Fig. 7. More 
specifically, the trajectory of the positions of the 
desired ZMP in the Y-axis direction in the first turning 
gait is set according to the same pattern as that shown in 
the lower diagram of Fig. 7. The trajectory of the 
positions of the desired ZMP in the Y-axis direction in 
the second turning gait is set to have the same shape as 
that for the first turning gait and connects to the end of 
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the trajectory. 

Subsequently, the processing proceeds to SI 12 and 
redefines the start time, the end time, and duration of 
one step (one cycle) of the normal gait as follows. 
5 A normal gait must be a gait in which state variables 

continuously connect at the start and the end thereof. To 
easily determine such a gait, in the present first 
reference example, the start, the end, and the duration of 
one step of a normal gait are determined as illustrated in 

10 Fig. 19 for convenience sake, which is different from the 
definition of a gait in the narrow sense described above. 
Specifically, in the latter half of a single stance period 
of the first turning gait, the time at which the floor 
reaction force vertical component has reduced to a certain 

15 degree is set as start time Ts of the normal gait. The 

start time Ts is preferably set to the time of the moment 
at which the state wherein substantially the entire 
surface of the sole of the supporting leg foot 22 is in 
contact with the ground is switched to tiptoe contact with 

20 the ground or at the time immediately preceding it, as 
shown in Fig. 7 (the time when the period of the entire 
sole surface in contact with the ground ends or the time 
immediately preceding it , as shown in Fig . 7 ) . A 
description will now be given of the relationship between 

25 the desired ZMP and time Ts shown in Fig. 22 (or Fig. 7) 
set in SllO. After substantially the entire surface of 
the sole of the supporting leg foot 22 comes in contact 
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With the ground In the first turning gait, the desired ZMP 
moves to the center of the supporting leg foot 22 . The 
instant the movement to the tiptoe is completed by the 
tiptoe contact with the ground is established is 
preferably time Ts, The start time Ts is set on the basis 
of, for example, the desired ZMP trajectory parameters 
previously set. The reason for setting the start time Ts 
as described above will be discussed hereinafter. 

As shown in Fig. 19, a cycle Tcyc of the normal gait 
is a sxm of the gait cycles of the first turning gait and 
the second turning gait. The end time of the normal gait 
is denoted by Te. Te is set to the time obtained by 
adding Tcyc to Ts. 

The definition of the start, the end, or the like of 
a gait will be returned to the definition of the gait in 
the aforesaid narrow sense again from the moment the 
normal gait is determined (the moment the sequence leaves 
the loop of S204 shown in Fig, 23). In the following 
explanation, the start time (the time at which the 
supporting leg foot 22 lands first) according to the 
definition of a gait based on the aforesaid narrow sense 
will be set to 0, and the above start time Ts used until 
the normal gait is determined will be distinguished from 
the original start time 0 by using the reference mark Ts 
(abbreviated to "Ts" in some cases). 

Lastly, the processing proceeds to S114 and sets a 
body posture angle and antiphase arm swing angle restoring 
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period [Tm, Ts2] and [Tni2, Te] of the normal gait. 
Supplementally, when the normal gait is repeated, the body 
posture angle and the antiphase arm swing angle should be 
continuous in a boundary of gaits. For this purpose, the 
5 beginning body posture angular velocity and the ending 
body posture angular velocity of the normal gait must 
agree with each other, and the beginning antiphase arm 
swing angular velocity and the ending antiphase arm swing 
angular velocity must agree with each other. The 

10 aforesaid period is the period for adjusting a body 

posture angle trajectory and an antiphase arm swing angle 
trajectory to implement the agreement. 

To be more specific, the gait goes through the 
floating period of the first turning gait from the start 

15 time Ts and reaches the second turning gait. The time at 
which the floor reaction force vertical component has 
increased to a predetermined magnitude is set as time Tm. 
Further, in the latter half of a single stance period of 
the second turning gait, the time at which the floor 

20 reaction force vertical component has reduced to a certain 
degree is set as time Ts2. Further, the gait goes through 
the floating period of the second turning gait and reaches 
the first turning gait. The time at which the floor 
reaction force vertical component has increased to a 

25 predetermined magnitude is set as time Tm2. 

Fig. 19 shows these times. The time Tm is preferably 
set to be the moment substantially the entire surface of 
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the sole of the supporting leg foot 22 comes In contact 
with the ground or Inunediately after that. The same 
applies to time Tm2. Time Ts2 is preferably set to the 
time of the moment at which the state wherein 
5 substantially the entire surface of the sole of the 

supporting leg foot 22 is in contact with the ground is 
switched to tiptoe contact with the ground or at the time 
immediately preceding it, as in the case of the start time 
Ts . 

10 A description will now be given of the relationship 

between the desired ZMP of Fig. 22 and these times Tm, Ts2 
and Tm2 set in the afore -mentioned SllO of Fig. 15. In 
the second turning gait, the desired ZMP takes the heel of 
the supporting leg foot 22 as the beginning position and 

15 remains at this position until substantially the entire 

surface of the sole of the supporting leg foot 22 comes in 
contact with the ground, and then the desired ZMP begins 
to move to the center of the supporting leg foot 22. It 
is desired to set this moment the desired ZMP beings to 

20 move to the center of the supporting leg foot 22 as time 
Tm. Thereafter, the instant the movement of the desired 
ZMP to the tiptoe is completed by the time only the tiptoe 
of the supporting leg foot 22 comes in contact with the 
ground is preferably set as time Ts2. Furthermore, in the 

25 next first turning gait, the desired ZMP takes the heel of 
the supporting leg foot 22 as the beginning position and 
remains at this position until substantially the entire 
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surface of the sole of the supporting leg foot 22 comes In 
contact with the ground, and then the desired ZMP begins 
to move to the center of the supporting leg foot 22. It 
is desired to set this moment the desired ZMP begins to 
5 move to the center of the supporting leg foot 22 as time 
Tm2 . 

The reason for setting as described above will be 
discussed hereinafter. The period for restoring 
(adjusting) the body posture angle and the period for 

10 restoring (adjusting) the antiphase arm swing angle may be 
separately set. 

After the processing from SOlO to S022 shown in Fig. 
13 is carried out, the processing proceeds to S024 and 
calculates an initial state of the normal gait. The 

15 initial state calculated here includes an initial 
horizontal body position/velocity (an initial body 
position and initial body velocity in the horizontal 
direction), an initial vertical body position/velocity (an 
initial body position and an initial body velocity in the 

20 vertical direction), an initial divergent component, an 
initial body posture angle and angular velocity, and an 
initial antiphase arm swing angle and angular velocity of 
the normal gait. The initial state is exploratorily 
calculated according to the flowchart of Fig. 23. 

25 In the flowchart of Fig. 23, first, in S200, an 

initial state (a state at the start time Ts) of a desired 
foot position/posture, a desired arm posture, and a 
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desired body posture angle (an Inclination angle and a yaw 
angle) are determined on the basis of the gait parameters 
of the normal gait (the parameters set In SO 2 2 of Fig. 13 
described above). The state here represents positions and 
5 posture angles and their changing rates (time 
differentiation) . 

In this case, the Initial state of a desired foot 
position/posture of a supporting leg Is determined by 
generating, using a finite- duration setting filter, a foot 

10 position/posture trajectory (a trajectory observed from a 
next time's gait supporting leg coordinate system) from 
the supporting leg foot position/posture at the start of 
the first turning gait of the foot trajectory parameter 
determined in SlOO of Fig. 15 to the free leg foot 

15 position/posture at the end of the second turning gait 

until time Ts is reached. The initial state of a desired 
foot position/posture of the free leg is determined by 
generating, using a finite-duration setting filter, a foot 
position/posture trajectory from the supporting leg foot 

20 position/posture at the start of the current time gait 

observed from a next time's gait supporting leg coordinate 
system to the free leg foot position/posture at the end of 
the first turning gait until time Ts is reached. The 
initial state of a desired arm posture is determined to be 

25 a reference arm posture at time Ts that is determined on 
the basis of the reference arm posture trajectory 
parameters determined in S104 of Fig. 15. To be more 
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specific, a total center-of -gravity position of both arms 
5, 5 (a relative position with respect to the body 3) of a 
desired arm posture, a lateral Interval between right and 
left hands (the distal ends of both arms 5, 5), and an 
5 antiphase arm swing angle and an angular velocity are 

determined • However, the antiphase arm swing angle and 
the angular velocity are corrected so that they are 
continuous In a boundary of gaits when a normal gait Is 
repeated, as It will be discussed hereinafter; therefore, 

10 they have been just temporarily determined. 

For an initial state of a desired body posture angle, 
a reference body posture (an inclination angle and a yaw 
angle) and an angular velocity thereof at time Ts 
determined by the reference body posture trajectory 

15 parameter determined in S102 of Fig. 15 are determined as 
an initial state of the desired body posture angle. In 
the present first reference example, the reference body 
posture related to the inclination angle of the body 3 is 
a vertical posture, so that the Initial state (the 

20 inclination angle and the angular velocity thereof) of the 
inclination angle in the desired body posture is zero. 

Further, in the present first reference example, a 
desired foot position/posture trajectory, a floor reaction 
force vertical component trajectory, and a desired ZMP 

25 trajectory of a normal gait are determined Independently 
from each other on the basis of a foot trajectory 
parameter, a floor reaction force vertical component 



- 109 - 



trajectory parameter, and a ZMP trajectory parameter, 
respectively, which have been determined in the flowchart 
of Fig. 15. For example, a desired foot position/posture 
at each instant of a normal gait is determined on the 
5 basis of a foot trajectory parameter without depending on 
an instantaneous value of a floor reaction force vertical 
component • 

Subsequently, in S202, (Xs, Vxs)(Xs: horizontal 
position; Vxs: horizontal velocity), which is a candidate 

10 of an initial horizontal body position/velocity (that is, 
a candidate of the horizontal body position/velocity at 
the start time Ts), is provisionally determined. The 
candidate (Xs, Vxs) to be provisionally determined may be 
arbitrary. For example, the horizontal body 

15 position/velocity in the initial state of the normal gait 
determined when the last time gait was generated may be 
used as a provisionally determined candidate (Xs, Vxs). 

To simplify the explanation, a case where the initial 
state of a normal gait in the X direction (longitudinal 

20 direction) on a sagittal plane is searched for will be 

taken as an example. However, for the initial state of a 
normal gait (the initial state that meets the aforesaid 
boundary condition of a normal gait), it is actually 
required to search for the position and the velocity in 

25 the X direction (longitudinal direction) and the Y 

direction (lateral direction) separately or simultaneously. 
Supplementally, there is no concept related to a yaw 
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rotation or a moment vertical component or the like about 
a vertical axis on the sagittal plane « For this reason, 
at least the yaw rotation and a moment vertical component 
are calculated In a three-dimensional space. 
5 As an exploratory determining technique, a method In 

which a pseudo- Jacobian (sensitivity matrix) is determined 
and then a next candidate is determined by the steepest 
descent method or the like, or the simplex method or the 
like may be used. In the present embodiment, the steepest 

10 descent method will be used. 

Next, the processing proceeds to S206 via S204 and 
determines the Initial (time Ts) vertical body 
position/velocity (Zs, Vzs)(Zs: vertical position; Vzs: 
vertical velocity) so that the vertical body 

15 position/velocity Is continuous and angles of joints, such 
as knees, will not be excessively large or small when the 
normal gait Is repeated. More details regarding this have 
been described in, for example, PCT/ JP02/13592 previously 
applied by the present applicant, and will be therefore 

20 omitted here. 

After the processing of S206, the processing proceeds 
to S208 to provisionally generate a normal turning gait 
(the normal turning gait provisionally generated may be 
hereinafter referred to as the provisional gait). To be 

25 more specific, based on the gait parameters of the normal 
gait determined in S022 of Fig. 13 described above, a 
desired ZMP, a desired floor reaction force vertical 
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component, a desired foot position/posture, a reference 
body posture, a desired arm posture, a floor reaction 
force horizontal component permissible range, and a floor 
reaction force moment vertical component permissible range 
at each Instant from the start time Ts to the end time Te 
are sequentially determined. Then, gaits from time Ts to 
the end time Te are generated by sequentially determining 
the body position/posture, taking the horizontal body 
posit Ion/ velocity (Xs, Vxs) and the vertical body 
position/velocity (Zs, Vzs) mentioned above as the Initial 
(time Ts) state of the body 3, and by using the aforesaid 
dynamic model (the model In Fig. 12) so as to satisfy the 
dynamic balance condition related to the determined 
desired ZMP and the desired floor reaction force vertical 
component and the condition of the floor reaction force 
horizontal component permissible range. At this time, the 
gaits are generated so that the body posture agrees with 
the reference body posture as much as possible. 

Moreover, an antiphase arm swing motion Is determined 
such that the condition related to the floor reaction 
force moment vertical component. I.e., the floor reaction 
force moment vertical component permissible range. Is 
satisfied. 

Incidentally, the gait generation of the normal gait 
Is performed merely Inside the gait generating device 100, 
and the generated gaits are not output to a composite - 
compliance operation determiner 104, which will be 
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discussed later, as desired values for driving the actual 
robot 1, 

The following will explain in detail the processing 
for generating a normal gait by sequential calculation, 
5 which is the processing in S208. 

Fig. 24 is a subroutine flowchart illustrating the 
processing. 

The explanation will now be given. In S300, various 
elements are initialized. Specifically, the start time Ts 

10 is substituted into time k for generating a provisional 
gait. Furthermore, a currently provisionally determined 
(Xs, Vxs) (determined in S202, or S216 or S218 of Fig. 23 
to be discussed hereinafter) is substituted into the 
horizontal body position/velocity, and the latest (Zs, 

15 Vzs) determined in the aforesaid S206 is substituted into 
the vertical body position/velocity. In addition, an 
initial value of a reference body posture angle (angle at 
the start time Ts) is substituted into the body posture 
angle, and an initial value of a reference body posture 

20 angular velocity (an angular velocity at the start time 

Ts) is substituted into the body posture angular velocity. 

A reference initial antiphase arm swing angle (angle 
at the start time Ts) is substituted into the antiphase 
arm swing angle, and a reference initial antiphase arm 

25 swing angular velocity (angular velocity at the start time 
Ts) is substituted into the antiphase arm swing angular 
velocity. 
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Subsequently, the processing proceeds to S304 via 
S302 and determines whether time k for generating a 
provisional gait Is before gait end time (whether k ^ Ts + 
Tcyc). If the determination result Is YES, then the 
5 processing proceeds to a gait Instantaneous value 
determining subroutine of S306 to determine a gait 
Instantaneous value. Subsequently, the processing of the 
gait generating device 100 proceeds to S308 to Increment 
time k for generating a provisional gait by Ak, and then 

10 returns to S304. 

Here, Ak Is an interval of the generation of 
provisional gaits and normally set to agree with a control 
cycle At. If the dynamic accuracy of provisional gaits is 
not demanding, then Ak may be set to be longer than At in 

15 order to reduce the volume of calculation. 

If the determination result of S304 is NO, then the 
processing proceeds to S310. The processing described 
above generates a normal gait (provisional gait) from its 
start to end before proceeding to S310. 

20 A gait instantaneous value determining subroutine of 

S306 will now be explained in detail with reference to Fig. 
25. 

First, in S400 of Fig. 25, based on a normal gait 
parameter (the floor reaction force vertical component 
25 trajectory parameter), a value (current time value) of the 
desired floor reaction force vertical component shown in 
Fig. 19 at time k is deteimlned. Further, in S402, a 
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value (current time value) of the desired ZMP trajectory 
shown in Fig. 22 at time k is determined on the basis of a 
normal gait parameter (the ZMP trajectory parameter). 

Then, the processing proceeds to S404 and determines 
5 the values (current time values) of desired 

positions/postures of both feet (desired foot 
positions/postures of both supporting leg and free leg), 
the reference body posture, and the reference arm posture 
at time k on the basis of the normal gait parameters (the 

10 foot trajectory parameter, the reference body posture 
trajectory parameter, and the arm posture trajectory 
parameter) . To be more specific about the reference arm 
posture, the values (current time values) of the total 
center-of -gravity position of both arms 5, 5 (the relative 

15 position with respect to the body 3), the lateral interval 
between right and left hands (the distal ends of both arms 
5, 5), and the antiphase arm swing angle are determined. 

The current time value (the value at time k) of the 
desired foot position/posture is determined in the same 

20 manner as in the case where the foot position/posture at 
the start time Ts was determined in S200 of Fig. 23. 

Then, the processing proceeds to S406 and calculates 
a value (current time value) of the total center-of - 
gravity vertical position/velocity at time k that 

25 satisfies the desired floor reaction force vertical 

component (balances the sum of the inert ial force in the 
vertical direction and gravity of the robot 1 with the 
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desired floor reaction force vertical component). To be 
more specific, the total center-of -gravity vertical 
position/velocity Is calculated on the basis of, for 
example, the above Equation 01 and Equation 04 related to 
5 the dynamic model shown In Fig. 12. In other words. 
Equation 01 and Equation 04 provide a relational 
expression (a dynamic equation related to the vertical 
direction of the total center of gravity of the robot 1 ) 
Indicating that the result obtained by multiplying the sum 

10 of the total center-of -gravity vertical acceleration and 

the gravity acceleration by a motion of the robot 1 by the 
total mass of the robot 1 Is equal to a floor reaction 
force vertical component. Thus, the total center-of - 
gravity vertical acceleration is determined from the 

15 relational expression and the desired floor reaction force 
vertical component. 

The relational expression Itself generally holds 
without depending on a model of the robot 1. The total 
center-of -gravity vertical velocity Is calculated by 

20 integrating the determined total center-of -gravity 

vertical acceleration, and further, the total center-of - 
gravity vertical velocity is Integrated to calculate the 
total center-of -gravity vertical position. More generally, 
these calculations are carried out using the dynamic 

25 relational expressions represented by the following 

Equation 15 and Equation 16 (dlscretlzed equations of 
Newton's dynamic equations). 
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Total center-of-gravlty vertical velocity at time k 
= Total center-of-gravity vertical velocity at time (k-Ak) 
+ ((Floor reaction force vertical component /Total mass of 
the robot) + acceleration of gravity) * Ak 

(where the acceleration of gravity takes a negative value) 

... Equation 15 

Total center-of-gravity vertical position at time k 
= Total center-of-gravity vertical position at time (k-Ak) 
+ Total center-of-gravity vertical velocity at time k « Ak 

... Equation 16 

Subsequently, the processing proceeds to S408 and 
calculates the vertical body position that satisfies the 
total center-of-gravity vertical position. To be more 
specific, the vertical body position is calculated using, 
for example. Equation 04 related to the model in Fig. 12. 
Specifically, the vertical positions of the supporting leg 
mass point 2m and the free leg mass point 2m of the model 
in Fig. 12 are determined from the current time values of 
the desired foot positions /postures of the supporting leg 
and the free leg. Then, these determined vertical 
positions of the supporting leg mass point 2m and the free 
leg mass point 2m and the current time value of the total 
center-of-gravity vertical position determined in S407 are 
applied to Equation 04 so as to determine the vertical 
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position of the body mass point 3m. Furthermore, the 
vertical body position is determined from the determined 
vertical position of the body mass point 3m and the 
current value of the desired body posture angle (the 
reference body posture angle set in S404 or the last time 
(time k-Ak) desired body posture angle determined in S414 
to be discussed hereinafter). 

The sequence then proceeds to S410 wherein the values 
(current time values), at time k, of the floor reaction 
force horizontal component permissible range [Fxmin, 
Fxmax] shown in Fig. 20 are determined on the basis of the 
gait parameter (the parameter defining the floor reaction 
force horizontal component permissible range) determined 
in S108 of Fig. 15 described above. 

Subsequently, the processing proceeds to S411 wherein 
the value (current time value), at time k, of the floor 
reaction force moment vertical component permissible range 
[Mzmin, Mzmax] shown in Fig. 21 is determined on the basis 
of the gait parameter (the parameter defining the floor 
reaction force moment vertical component permissible 
range) determined in S109 of Fig. 15 described above. 

Then, the processing proceeds to S412 wherein the 
current time values of the desired horizontal body 
acceleration and the desired body posture acceleration are 
determined such that the dynamic balance condition related 
to the desired ZMP (the condition in that the horizontal 
component of a moment generated about the desired ZMP by a 
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resultant force of an Inertial force and the gravity of 
the robot 1 Is zero) Is satisfied. The horizontal body 
acceleration and the body posture angular acceleration 
(more specifically, the body inclination angular 
5 acceleration) are determined such that the floor reaction 
force horizontal component Fx does not exceed [Fxmin, 
Fxmax] . Further, the current time value of the desired 
antiphase arm swing angular acceleration is determined 
such that the floor reaction force moment vertical 
10 component Mz does not exceed [Mzmin, Mzmax] . 

In the body posture angle, the yaw angle is 
determined so as to agree with the yaw angle of the 
reference body posture angle. Regarding the desired arm 
posture, components other than the antiphase arm swing 
15 angle are determined to agree with the reference arm 

posture. At this time, the desired body inclination angle 
and the desired antiphase arm swing angle are determined 
to follow the reference body inclination angle and the 
reference antiphase arm swing angle, respectively, as much 
20 as possible, while satisfying the aforesaid condition. 
This will be explained in detail below. 

At this point, the instantaneous values (current time 
values) of the foot position/posture and the vertical body 
position have been determined as described above. 
25 Regarding the arm posture, the components other than the 
antiphase arm swing angle have been determined to agree 
with those of the reference arm posture. Therefore, once 
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the remaining horizontal body position, body posture angle 
and antiphase arm swing angle are determined, the desired 
motion of the robot 1 will be uniquely determined. Hence, 
all floor reaction forces will be also uniquely determined. 
5 In the present first reference example, the desired floor 
reaction force vertical component and the desired ZMP of a 
normal gait are defined by the floor reaction force 
vertical component trajectory parameters and the desired 
ZMP trajectory parameters, respectively, determined In 

10 S022 of Fig. 13 described above. 

When generating a gait. If the body Inclination mode 
is primarily used to satisfy a desired ZMP (to set the 
horizontal component of a floor reaction force moment 
about a desired ZMP to zero) without using the aforesaid 

15 body translatlonal mode much, then the body posture angle 
may become excessively large. To prevent this, therefore, 
the body translatlonal mode should be used as much as 
possible. However, the body translatlonal mode involves 
floor reaction force horizontal component changes, so that 

20 slippage may occur if the body translatlonal mode is 
Intensely effected when the floor reaction force 
horizontal component permissible range is narrow. In this 
case, depending upon the body inclination mode is an 
inevitable choice. Especially during a period in which 

25 the floor reaction force horizontal component permissible 
range is zero, as in the aforesaid running gait, it is 
impossible to generate a gait that produces a floor 
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reaction force horizontal component. Hence, depending 
upon the body Inclination mode Is an Inevitable choice. 

Meanwhile, an antiphase arm swing motion allows only 
the floor reaction force moment vertical component to be 
changed without changing any of the horizontal component 
of a floor reaction force moment about a desired ZMP and 
the floor reaction force horizontal component, so that It 
can be used to prevent the floor reaction force moment 
vertical component from exceeding the aforesaid floor 
reaction force moment vertical component permissible range. 
Considering the above, in the present first reference 
example, the horizontal body acceleration, the body 
posture angular acceleration, and the antiphase arm swing 
acceleration are determined according to the flowchart 
shown in Fig. 26. For the convenience of understanding, 
regarding the determination of the horizontal body 
acceleration and the body posture angular acceleration 
(the angular acceleration of an inclination angle of the 
body 3), a case where the horizontal body acceleration and 
the body posture angular acceleration in the X direction 
(longitudinal direction) are determined on a sagittal 
plane will be taken as an example. Actually, however, the 
horizontal body acceleration and the body posture angular 
acceleration in the Y direction (lateral direction) are 
also determined in the seune manner as that for the X 
direction. 

First, in S500, the value of the reference body yaw 



angle at time k Is substituted Into the desired body yaw 
angle . Further , the value of a reference arm posture at 
time k Is substituted Into the desired arm posture, 
excluding the antiphase arm swing angle and the angular 
velocity component of an arm posture. 

Then, In S502, It Is determined whether the current 
time (the value of a timer for generating a normal gait) k 
Is In the period of restoring a body posture angle and an 
antiphase arm swing angle (the period of restoring a body 
posture angle and an antiphase arm swing angle being the 
period from time Tm to time Ts2 and the period from time 
Tm2 to Te In the case of a normal gait). The processing 
proceeds to S504 If the determination result of S502 Is NO, 
or to S530 If the determination result Is YES. 

In S504, a horizontal body acceleration atmp Is 
determined, which Is required to satisfy the current (time 
k) desired ZMP If the robot 1 Is made to perform a motion 
of the body translatlonal mode from a last time 
Instantaneous gait state (the gait state at time k-1) of 
the robot 1, with the angular acceleration of the body 
Inclination mode being set to zero. The atmp Is 
determined using, for example, the above Equation 03y 
related to the dynamic model of Fig. 12 described above. 
To be more specific, for example, time series values of 
desired foot positions /postures determined up to the 
current time k are used to determine the vertical 
accelerations of the supporting leg mass point 2m and the 
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free leg mass point 2m at the current time k, and a 
desired foot position/posture at the current time k 
(current time) is used to determine the vertical positions 
of the supporting leg mass point 2m and the free leg mass 
point 2m. Furthermore, the floor reaction force vertical 
position at the current time k (current time) is used to 
determine the vertical position of the body mass point 3m, 
and the vertical acceleration of the body mass point 3m at 
the current time k is determined by using time series 
values of the desired vertical body positions determined 
up to the current time k. Then, these determined values 
are substituted into the above Equation 03y, and an 
equation obtained by setting My and d2eby/dt2 of the 
Equation 03y to zero is solved on d2Xb/dt2 so as to 
determine the body mass point horizontal acceleration as 
the horizontal body acceleration atmp. A more precise 
dyneunic model may be used to exploratorlly determine the 
horizontal body acceleration atmp that sets the horizontal 
component of the floor reaction force moment about the 
desired ZMP to zero. Further, in the present first 
reference example, the reference body posture related to 
the inclination angle of the body 3 is the vertical 
posture and the body posture angular acceleration (the 
angular acceleration of the inclination angle of the body 
3) in the reference body posture is zero, so that the 
angular acceleration in the body inclination mode was set 
to zero to determine the horizontal body acceleration atmp. 



- 123 - 



If, however, the reference body posture trajectory 
parameters are set so that the Inclination angle of the 
reference body posture changes and if the reference body 
posture angular acceleration (the reference angular 
5 acceleration of the inclination angle of the body 3) at 
the current time k determined thereby is not zero, then 
the angular acceleration in the body inclination mode may 
be set to the value of the reference body posture angular 
acceleration, which is not zero, to determine the 

10 horizontal body acceleration atmp by using a dynamic model 
(for example, d2eby/dt2 of Equation 03y may be set to a 
reference body posture angular acceleration that is not 
zero to determine the horizontal body acceleration atmp in 
the same manner as described above) . 

15 Next, the processing proceeds to S506 wherein a floor 

reaction force horizontal component Fxtmp at time k when 
the horizontal body acceleration is atmp is determined 
using a dynamic model. In the present first reference 
example, Fxtmp is determined using Equation 02x of the 

20 dynamic model. In other words, Fxtmp is determined 

according to the following Equation 17, where d2Xsup/dt2 
and d2Xswg/dt2 denote the supporting leg foot mass point 
horizontal acceleration and the free leg foot mass point 
horizontal acceleration at time k. 

25 

Fxtmp = mb * atmp + msup * d2Xsup/dt2 

+ mswg * d2Xswg/dt2 Equation 17 
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An example of Fxtmp determined as described above Is 
shown In Fig. 27. In Fig. 27, a portion wherein Fxtmp 
exceeds the floor reaction force horizontal component 
permissible range [Fxmin, Fxmax] is hatched. 

Subsequently, the processing proceeds to S508 wherein 
a horizontal body acceleration a in the body translational 
mode and a floor reaction force horizontal component Fx 
generated thereby, and a body angular acceleration p in 
the body inclination mode are determined as shown below 
(S508 to S516) . 

Specifically , 

If Fxtmp > Fxmax, then the processing proceeds to 
S510 wherein Fx is determined according to the following 
equation. 

Fx = Fxmax ... Equation 18 

If Fxtmp < Fxmin, then the processing proceeds to 
S512 wherein Fx is determined according to the following 
equation. 

Fx = Fxmin ... Equation 19 

In other cases, that is, if Fxtmp lies within the 
floor reaction force horizontal component permissible 
range [Fxmin, Fxmax], then the processing proceeds to S514 
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wherein Fx Is determined according to the following 
equation. 

Fx = Fxtmp ... Equation 20 

In any case, the processing proceeds to S516 wherein 
the horizontal body acceleration a and the body posture 
angular acceleration (body Inclination angular 
acceleration) p are determined according to the following 
equations • 

a = atmp + ( Fx- Fxtmp ) /AFp ... Equation 21 
p = (atmp -a) * AMp/AMr ... Equation 22 

where AFp, AMp, and AMr are determined according to 
the above Equations 06, 07, and Equation 09, respectively. 

Supplementally, If higher accuracy of the dynamic 
calculation Is required, then, after determining the body 
angular acceleration p as described above, the horizontal 
body acceleration a In the body translatlonal mode should 
be analytically or exploratorlly determined by using a 
more precise dynamic model so that a motion obtained by 
combining the body translatlonal mode and the body 
Inclination mode of the above determined body angular 
acceleration p satisfies the desired ZMP. As an 
exploratory determining method, a method In which a 
pseudo- Jacoblan (sensitivity matrix) Is determined and 
then a next candidate Is determined by the pseudo -Newton 



- 126 - 



method or the like, or the simplex method or the like may- 
be used . 

Further, in order to strictly prevent the floor 
reaction force horizontal component Fx from exceeding the 
5 floor reaction force horizontal component permissible 
range [Fxmin, Fxmax] , a set of the horizontal body 
acceleration a and the body angular acceleration p may be 
exploratorily searched for such that Fx«Fxmax and the 
horizontal component of the floor reaction force moment 

10 about the desired ZMP is zero in S510 and also Fx=Fxmin 
and the horizontal component of the floor reaction force 
moment about the desired ZMP is zero in S512. 

Fig. 28 shows Fx determined as described above « Fx 
has been limited (saturated) so that a value of Fxtmp does 

15 not exceed the floor reaction force horizontal component 
permissible range [Fxmin, Fxmax] . More specifically, 
Fxtmp is directly used as Fx if Fxtmp based on the 
horizontal body acceleration atmp by the body 
translational mode alone lies within the permissible range 

20 [Fxmin, Fxmax] . If Fxtmp based on the horizontal body 
acceleration atmp by the body translational mode alone 
exceeds an upper limit of the permissible range [Fxmin, 
Fxmax] or reduces below a lower limit thereof, then Fx is 
forcibly limited to Fxmax and Fxmin, respectively. 

25 Especially in a floating period of a running gait, 
Fxmax=Fxmin=0 applies all the times, so that Fx=0. 

Fig. 29 shows the body posture angular acceleration p 
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determined as described above. Thus, an Insufficient 
portion of the floor reaction force moment caused by 
limiting the acceleration In the body translatlonal mode 
so as to prevent Fx generated by the body translatlonal 
mode from exceeding the permissible range [Fxmln, Fxmax] 
(more specifically, the moment obtained by subtracting a 
moment component produced by a limited body horizontal 
motion and the motions of both legs 2, 2 from an inertlal 
force moment required for reducing the horizontal 
component of a floor reaction force moment about the 
desired ZMP to zero) has been compensated for by the body 
inclination mode. During a floating period of a running 
gait, the horizontal body acceleration a by the body 
translatlonal mode is always limited to zero, so that the 
insufficient portion of the floor reaction force moment is 
compensated for only by the body posture angular 
acceleration p by the body inclination mode. 

Subsequently, the processing proceeds to S518 to 
determine a floor reaction force moment vertical component 
Mztmp when a motion in which, for example, a horizontal 
body acceleration in the body translatlonal mode is a, a 
body angular acceleration (body inclination angular 
acceleration) in the body inclination mode is p, a body 
acceleration in the body yaw rotation mode (body yaw 
angular acceleration) is a reference yaw angular 
acceleration d2ebzref /dt2 , and an antiphase arm swing 
angular acceleration pa is a reference antiphase arm swing 
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angular acceleration daBazref /dt2 , Is performed. 
Hereinafter, d2ebzref/dt2 will be Pbref , and d2eazref/dt2 
will be Paref . 

To be more specific, Mz obtained by substituting 
Equation 1001 through Equation 1004 into Equation 03z is 
Mztmp. 



d2Xb/dt2=ax 
d2Yb/dt2=ay 
d20bz/dt2=pbref 
d2eaz/dt2=paref 



... Equation 1001 
... Equation 1002 
... Equation 1003 
... Equation 1004 



where ox denotes an X component of the horizontal 
body acceleration a, and ay denotes a Y component of the 
horizontal body acceleration a. Furthermore, a horizontal 
body position at time k-1 is substituted into Xb and Yb, 
and a value of time k is substituted into Xzmp, Yzmp, Xsup, 
d2ysup/dt2, Xswg, and d2Yswg/dt2. 

Fig. 32 shows an example Mztmp determined as 
described above. In Fig. 32, the portion of Mztmp that 
exceeds the floor reaction force moment vertical component 
permissible range [Mzmin, Mzmax] is shown by hatching. 

Next, the processing proceeds to S520 wherein an 
antiphase arm swing angular acceleration Pa is determined 
as shown below (S520 - S528). 

Specifically, 

If Mztmp > Mzmax, then the processing proceeds to 
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S522 wherein Mz is determined according to the following 
equation. 

Mz = Mzmax ... Equation 1018 

If Mztmp < Mzmin, then the processing proceeds to 
S524 wherein Mz is determined according to the following 
equation. 

Mz = Mzmin ... Equation 1019 

In other cases, that is, if Mztmp lies within the 
floor reaction force horizontal component permissible 
range [Mzmin, Mzmax], then the processing proceeds to S526 
wherein Mz is determined according to the following 
equation. 

Mz = Mztmp ... Equation 1020 

In any case, the processing proceeds to S528 wherein 
the antiphase arm swing angular acceleration Pa is 
determined according to the following equation. 

Pa = paref + (Mztmp-Mz ) /AMaz ... Equation 1021 

where AMaz is determined according to Equation 09a. 
The following will explain the processing from S518 
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to S528, 

Mz determined as described above denotes a floor 
reaction force moment vertical component from a motion of 
the entire robot. Including an antiphase arm swing. 

In the above processing, the antiphase arm swing 
angular acceleration pa has been determined such that the 
Mz does not exceed the floor reaction force moment 
vertical component permissible range [Mzmln, Mzmax] . To 
be more specific, Mz has been determined to be limited 
(saturated) so that a value of Mztmp does not exceed the 
floor reaction force horizontal component permissible 
range [Mzmln, Mzmax], as shown In Fig. 33. More 
detalledly, Mztmp Is directly used as Mz If Mztmp lies 
within the permissible range [Mzmln, Mzmax]. If Mztmp 
exceeds an upper limit of the permissible range [Mzmln, 
Mzmax] or reduces below a lower limit thereof, then Mz Is 
forcibly limited to Mzmax and Mzmln, respectively. 
Especially In a floating period of a running gait, 
Mzmax=Mzmln=0 applies all the times, so that Mz=0. 

A moment vertical component Maz to be generated by an 
antiphase arm swing In order to prevent Mz from exceeding 
the floor reaction force moment vertical component 
permissible range [Mzmln, Mzmax] Is obtained by (Mz -Mztmp ) . 
Maz(=:: Mz -Mztmp) Is shown In Fig. 34. 

The antiphase arm swing angular acceleration Pa can 
be obtained by adding the result obtained by dividing Maz 
by an equivalent Inertlal moment AMaz of an antiphase arm 
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swing to a reference antiphase arm swing angular 
acceleration paref (a value obtained by subjecting a 
reference antiphase arm swing angle to second order 
differentiation). Specifically, pa Is determined 
5 according to the above Equation 1021. The antiphase arm 
swing angular acceleration pa is shown In Fig. 35. 

As described above. In the processing from S504 to 
S528, the antiphase arm swing angular acceleration pa is 
determined such that the floor reaction force moment 

10 vertical component Mz generated by a motion of the entire 
robot, including an antiphase arm swing, does not exceed 
the permissible range [Mzmln, Mzmax] (such that the floor 
reaction force moment vertical component Mztmp offsets 
(cancels) the portion of the floor reaction force moment 

15 vertical component Mztmp that exceeds the permissible 

range, the floor reaction force moment vertical component 
Mztmp being generated when an antiphase arm swing angular 
acceleration is set to agree with the reference antiphase 
arm swing angular acceleration paref). 

20 Supplementally, to strictly prevent the floor 

reaction force moment vertical component Mz from exceeding 
the floor reaction force moment vertical component 
permissible range [Mzmln, Mzmax], the antiphase arm swing 
angular acceleration pa should be analytically or 

25 exploratorlly determined by using a more precise dynamic 

model in place of the processing from S504 to S528. As an 
exploratory determining method, a method in which a 
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pseudo-Jacobian (sensitivity matrix) Is determined and 
then a next candidate Is determined by the pseudo- Newton 
method or the like, or the simplex method or the like may 
be used. 

5 The above processing Is performed If time k Is not 

found during the period of restoring a body posture angle 
and an antiphase arm swing angle. 

If a determination result of S502 Is YES, then the 
following processing will be carried out. First, the 

10 processing proceeds to S530 to determine the horizontal 

body acceleration a required to satisfy the desired ZMP of 
current time (time k) when the robot 1 Is made to perform 
a motion of the body translatlonal mode, with the angular 
acceleration in the body inclination mode being set to 

15 zero, from the last time instantaneous gait state (the 
gait state at time k-1) of the robot 1, and this is 
determined as a final horizontal body acceleration. 

Next, the processing proceeds to S532 wherein the 
floor reaction force horizontal component Fx in the 

20 aforesaid case is determined. 

Next, the processing proceeds to S534 wherein the 
body posture angular acceleration (the body inclination 
angular acceleration) p is determined to be zero. The 
body yaw angular acceleration is determined to be the 

25 reference body yaw angular acceleration pbref (the value 
obtained by subjecting the reference body yaw angle to 
second order differentiation). 
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Lastly^ the processing proceeds to S536 wherein the 
reference antiphase arm swing angular acceleration paref 
(the value obtained by subjecting the reference antiphase 
arm swing angle to second order differentiation) Is 
5 substituted Into the antiphase arm swing angular 
acceleration Pa. 

The above Is the processing carried out If the 
determination result of S502 Is YES, More specifically. 
In this case, the body posture angular acceleration (the 

10 body Inclination angular acceleration and the body yaw 

angular acceleration) Is set to agree with the reference 
body posture angular acceleration, and the antiphase aanrn 
swing angular acceleration Is set to agree with a 
reference antiphase arm swing angular acceleration. It Is 

15 expected that this setting will not cause a floor reaction 
force generated by a motion to exceed the floor reaction 
force horizontal component permissible range and the floor 
reaction force moment vertical component permissible 
range; therefore, determining as described above will 

20 present no problem. 

After the processing of S528 or S536, the processing 
proceeds to S414 of Fig. 25 wherein the horizontal body 
acceleration determined In S412 Is sequentially Integrated 
(cumulative addition from time Ts to current time k) so as 

25 to determine a horizontal body velocity, and further, the 
horizontal body velocity Is sequentially Integrated 
(cumulative addition from time Ts to current time k) so as 
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to determine a horizontal body position (current time 
value). Further, the body posture angular acceleration 
determined In S412 Is sequentially Integrated (cumulative 
addition from time Ts to the current time k) so as to 
5 determine a body posture angular velocity, and further, 
the body posture angular velocity Is sequentially 
Integrated (cumulative addition from time Ts to the 
current time k) so as to determine a body posture angle 
(current time value). 

10 The processing then proceeds to S416 wherein the 

antiphase arm swing acceleration pa determined In S412 Is 
sequentially Integrated (cumulative addition from time Ts 
to the current time k) so as to determine an antiphase arm 
swing velocity, and further, the determined antiphase arm 

15 swing velocity Is sequentially Integrated (ctmiulatlve 
addition from time Ts to the current time k) so as to 
determine an antiphase arm swing angle Oaz (current time 
value ) . 

After the normal gait Instantaneous value determining 
20 subroutine of S306 In Fig. 24 Is carried out, the 

processing proceeds to S308 wherein the value of time k 
for generating a gait is Incremented by a gait generation 
Interval Ak. Then, the processing returns to S304 to 
repeat the processing of S306 and S308 as long as the 
25 condition shown in S304 is satisfied. When the condition 
shown in S304 is no longer satisfied, that is, when the 
generation of provisional gaits up to the end (time Te = 
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Ts+Tcyc) is completed, the processing proceeds to S310. 

For a normal gait, an initial body posture angle and 
its angular velocity must be determined such that motional 
states of the robot 1 are not discontinuous at boundaries 
when the normal gait is repeated. 

Hence, in S3 10, a pattern of a ZMP- converted value 
(hereinafter referred to as the body posture restoring 
moment ZMP -converted value and abbreviated to ZMPrec) of a 
floor reaction force moment for generating a body posture 
angular acceleration for setting a body posture angular 
velocity back to an initial value (the value at time Ts) 
by time Te is set. 

This will be explained in detail below. 

The following will discuss the procedure for setting 
a body posture angular velocity back to an initial value 
(the value at time Ts) by generating a body posture 
angular acceleration by using the body inclination mode 
during the period of restoring a body posture angle and an 
antiphase arm swing angle (the period from time Tm to time 
Ts2 and from time Tm2 to Te) . A body posture angular 
acceleration pattern for this purpose is denoted by P(k) . 
In periods other than the above-mentioned period, P(k)=0 
will apply. 

In the body inclination mode, generating the body 
posture angular acceleration p(k) will generate a floor 
reaction force moment p(k)*AMr. As a result, if the floor 
reaction force vertical component at that instant is 
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denoted by Fz{k), then ZMP(k) calculated from a motion 
(rather than a desired ZMP) will be shifted by AZMP 
determined according to the following equation. 

5 AZMP(lc) « -P(k)*AMr/Fz(k) ... Equation 23 

Therefore, if the pattern of AMr and the pattern of 
Fz(k) have been determined (known), then the body posture 
angular velocity can be set back to the initial value (the 

10 value at time Ts ) , that is, the body posture angular 

velocity in an initial (time Ts) state of the reference 
body posture trajectory by appropriately setting a pattern 
of AZMP(k) to generate a body posture angular acceleration 
pattern that satisfies Equation 23. 

15 The aforesaid body posture restoring moment ZMP- 

converted value (ZMPrec) means AZMP(k) that has been 
appropriately set as described above. Strictly speaking, 
AMr varies when setting the body posture restoring moment 
ZMP-converted value by using the above Equation 23, but it 

20 may be approximately set at a constant value. This is 

because the normal gait is merely generated for temporary 
use and not used to make an actual robot follow the gait, 
so that the dynamic accuracy of a normal gait does not 
have to be very high. 

25 Fig. 30 illustrates an example of ZMPrec. In Fig. 30, 

as a pattern of ZMPrec, trapezoidal patterns are formed 
for the period from time Tm to time Ts2 and for the period 



- 137 - 



from time Tm2 to time Te. The times of break points of 
the trapezoidal portions are set to agree with the times 
of break points of a desired ZMP pattern in the period 
between time Tm and time Ts2 and the period from Tm2 to Te 
5 (refer to Fig. 22). This is because correction of the 

desired ZMP pattern of a current time gait will be easier, 
as it will be discussed hereinafter. 

Substituting ZMPrec(k) into AZMP(k) of Equation 23 
provides the following equation. 

10 

p(k) ^ -ZMPrec(k)*Fz(k)/AMr ... Equation 24 

Therefore, p(k) determined in this Equation 24 will 
be as indicated by the solid lines in Fig. 31. The dashed 

15 lines in Fig. 31 indicate the body posture angular 

acceleration during the period from time Ts to time Tm and 
the period from time Tm2 to Te (indicated by the solid 
lines in Fig. 29). (Hereinafter, (k) may be omitted if a 
value is obviously the value at time k. ) 

20 The initial (time Ts) body posture angle is set to 

agree with the initial (time Ts) reference body posture 
angle . 

Further, the initial body posture angular velocity is 
determined to satisfy Equations 37a and 37b. 

25 

Terminal body posture angle - Initial body posture angle 
« Second order integration of a body posture angular 
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acceleration that has been determined to satisfy a floor 
reaction force horizontal component permissible range 

+ Second order Integration of a body posture angular 
acceleration generated by ZMPrec 

+ Initial body posture angular velocity * Cycle of 
normal gait 

Equation 37a 

Terminal body posture angular velocity - Initial body 
posture angular velocity 

= First order integration of a body posture angular 
acceleration that has been determined to satisfy a floor 
reaction force horizontal component permissible range 

+ First order integration of a body posture angular 
acceleration generated by ZMPrec 

Equation 37b 

The integration period of the first term of the right 
side of each of Equations 37a and 37b is the period 
combining the period from time Ts to Tm and the period 
from Ts2 to Tm2, while the integration period of the 
second term of the right side is the period combining the 
period from time Tm to Ts2 and the period from Tm2 to Te. 

To explain more specifically, in a normal gait, an 
initial state posture angle and an angular velocity 
observed from a supporting leg coordinate system of a 
first turning gait (a next time's gait supporting leg 
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coordinate system) must agree with a terminal body posture 
angle and angular velocity, respectively, observed from a 
supporting leg coordinate system of the next first turning 
gait (the next but two time's gait supporting leg 
5 coordinate system). Therefore, in the present first 
reference example, the initial (time Ts) body posture 
angle is determined to be the value of the initial (time 
Ts) reference body posture angle, and this value and the 
value obtained by subjecting this value to coordinate 

10 conversion into a value observed from the next time's gait 
supporting leg coordinate system by a matrix (matrix of 
rotational coordinate conversion) based on a total turning 
angle (turning angle about a vertical axis) of the robot 1 
in a normal gait are substituted into the initial body 

15 posture angle and the terminal body posture angle, 

respectively, in the left side of Equation 37a, The body 
posture angular acceleration determined in S518 of Fig. 26 
described above is used as the body posture angular 
acceleration related to the integration of the first term 

20 of the right side of Equations 37a and 37b. 

Then, the initial body posture angular velocities of 
Equations 37a and 37b and the heights of the trapezoids of 
ZMPrec (the trapezoidal patterns shown in Fig. 30) related 
to the integration of the second terms of the right sides 

25 of Equations 37a and 37b are taken as unknown numbers 

(However, the times of the break points of the trapezoidal 
patterns of ZMPrec are determined beforehand. Further, a 
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trapezoidal height acycl of ZMPrec of a first turning gait 
and a trapezoidal height acyc2 of ZMPrec of a second 
turning gait are set to have the same value.) An initial 
body posture angular velocity determined by solving the 
5 simultaneous equation of Equations 37a and 37b including 
the unknown numbers is decided as a new initial body 
posture angular velocity. In this case, the terminal body 
posture angular velocity in Equation 37b is obtained by 
coordinate-converting the initial body posture angular 

10 velocity, which is an unknown number, into a value 

observed from a next time's supporting leg coordinate 
system by a matrix based on the above total turning angle 
of a normal gait . 

Subsequently, the processing proceeds to S312 wherein 

15 an amount of influence exerted by a body inclination 

restoring moment ZMP-converted value (ZMPrec) pattern on a 
horizontal body position and velocity is determined on the 
basis thereof, and the determined amount is added to the 
terminal horizontal body position and velocity. 

20 This processing will be explained. The details 

thereof have been explained in PCT/ JP02/13592 by the 
present applicant, so that only a brief explanation will 
be given here . 

During the period from time Ts to Tm and the period 

25 from time Ts2 to Te, if the body posture angular 

acceleration p is changed to generate the body inclination 
restoring moment ZMP-converted value (ZMPrec) pattern, as 
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described above, then the body posture angular 
acceleration p Is determined according to the following 
equation . 

5 p = -ZMPrec*Fz/AMr ... Equation 1025 

The horizontal body acceleration that satisfies the 
desired ZMP when no body Inclination restoring moment Is 
generated Is atmp as determined In S532. When the body 
10 posture angular acceleration p Is changed as described 
above, the horizontal body acceleration a required to 
satisfy the desired ZMP Is determined according to the 
following equation. 

15 a = atmp - (AMr/AMp) * p ... Equation 1026 

From Equations 1025 and 1026, 

a = atmp + ZMPrec * Fz/AMp ... Equation 1027 

20 

In other words, the acceleration Is Increased by an 
equivalent to the second term of the right side of 
Equation 1027 by the body Inclination restoring moment 
ZMP -converted value (ZMPrec). 
25 Using the linearity of the equations, the terminal 

horizontal body velocity obtained when the body posture 
angular acceleration p Is changed to generate the body 
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Inclination restoring moment ZMP-converted value (ZMPrec) 
pattern as described above will be determined by adding 
the first order Integration of { ZMPrec*Fz/AMp) from time 
Ts to Te to the terminal horizontal body velocity obtained 
when the body Inclination restoring moment ZMP-converted 
value (ZMPrec) pattern is not generated. I.e., the 
terminal value of the horizontal body velocity determined 
in S414. Further, the terminal horizontal body position 
obtained when the body posture angular acceleration p is 
changed to generate the body inclination restoring moment 
ZMP-converted value (ZMPrec) pattern as described above 
will be determined by adding the second order integration 
of (ZMPrec*Fz/AMp) from time Ts to Te to the terminal 
horizontal body position obtained when the body 
inclination restoring moment ZMP-converted value (ZMPrec) 
pattern is not generated, i.e., the terminal value of the 
horizontal body position determined in S414. 

After completing the processing of S312, the 
processing proceeds to S314 wherein an antiphase arm swing 
restoring angular acceleration (parec) pattern is 
determined such that the antiphase arm swing angular 
velocities at a start and an end agree. 

To be more specific, the antiphase arm swing 
restoring angular acceleration patterns are set to be 
trapezoidal, as shown in Fig. 36, and a trapezoidal height 
azcyc2 in the period from time Tm to Ts2 and a trapezoidal 
height azcycl in the period from time Tm2 to Te are set to 
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be the same. The trapezoidal heights azcycl and azcyc2 
are determined such that the sum of the Integrated value 
of parec from time Ts to Te and the integrated value of 
the above determined antiphase arm swing acceleration pa 
5 for preventing the floor reaction force moment vertical 
component Mz from exceeding a permissible range becomes 
zero. The trapezoidal heights in the two periods do not 
have to be the seune. 

Supplementally, a floor reaction force moment 

10 vertical component (Mazrec) generated by the antiphase arm 
swing restoring angular acceleration pattern determined as 
described above is as shown in Fig. 37. Accordingly, as 
shown in Fig. 38, the floor reaction force moment vertical 
component Mz generated by a motion of the robot, including 

15 an antiphase arm swing, will be eventually the sum of 

Mztmp of Fig. 32, Maz of Fig. 34, and Mazrec of Fig. 37, 
i.e., the sum of Mz of Fig. 33 and Mazrec of Fig. 37. In 
the period from time Tm to Ts2 and the period from time 
Tm2 to Te, trapezoidal restoring moments are added. These 

20 periods are set so as to provide a sufficiently wide 

permissible range; therefore, the floor reaction force 
moment vertical components generated by motions of the 
robot, including antiphase arm swings, will not exceed the 
permissible range. 

25 The processing then proceeds to S3 16 wherein an 

initial (time Ts) antiphase arm swing angle and angular 
velocity of a normal gait are determined. 
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To be more specific, the Initial antiphase arm swing 
angular velocity Is determined according to the following 
equation. 

Initial antiphase arm swing angular velocity 

= Reference Initial antiphase arm swing angular velocity 
- (Antiphase arm swing angle when parec Is 0 

+ Second order Integration of parec pattern /Tcyc 

... Equation 1030 
where In the above equation, the antiphase arm swing 
angle when ^arec Is zero Is the antiphase arm swing angle 
(the antiphase arm swing angle at time Te) determined In 
S416. The second order Integration of Parec refers to a 
second order Integrated value of the antiphase arm swing 
restoring angular acceleration from time Ts to Te set as 
shown In Fig. 36. The reference Initial antiphase arm 
swing angular velocity refers to the value of the 
aforesaid reference antiphase arm swing angular velocity 
(the first order differential value of the reference 
antiphase arm swing angle Oaref) at time Ts. 

The Initial antiphase arm swing angle Is set to agree 
with the reference Initial antiphase arm swing angle. 
Alternatively, based on a finally determined antiphase arm 
swing angular acceleration (that Is, the above determined 
sum of antiphase arm swing acceleration pa and the 
restoring angular acceleration parec for preventing the 
floor reaction force moment vertical component Mz from 
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exceeding a permissible range) and the above determined 
Initial antiphase arm swing angular velocity, the average 
value of the difference between an arm swing angle 
calculated when an Initial antiphase arm swing angle Is 
5 set to agree with a reference Initial antiphase arm swing 
angle and a reference antiphase arm swing angle, or an 
average value of the maximum value and the minimum value 
of the difference may be determined, and then the value 
obtained by subtracting a half of the determined average 

10 value from the reference Initial antiphase arm swing angle 
may be determined as the final Initial antiphase arm swing 
angle. This arrangement makes It possible to prevent the 
absolute value of the difference between a calculated arm 
swing angle and the reference antiphase arm swing angle 

15 from becoming excessively large. 

One of the reasons that times Ts, Tm, Ts2, and Tm2 
have been set as described above is to prevent the floor 
reaction force horizontal component Fx from exceeding the 
permissible range [Fxmin, Fxmax] even if the body posture 

20 angular acceleration p is generated to set the body 
posture angular velocity back to the initial angular 
velocity of a reference body posture trajectory during the 
period from time Tm to Ts2 and the period from time Tm2 to 
Te. In other words, the floor reaction force horizontal 

25 component permissible range is sufficiently wide in the 

period from time Tm to Ts2 and the period from time Tm2 to 
Te, so that the floor reaction force horizontal component 
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Fx does not exceed the permissible range even If the body 
posture angular acceleration p Is generated to restore the 
body posture angular velocity, while satisfying the 
desired ZMP. 

5 Another reason that the times Ts, Tm, Ts2, and Tm2 

have been set as described above Is to prevent the floor 
reaction force moment vertical component Mz from exceeding 
the permissible range [Mzmln, Mzmeix] even If the antiphase 
arm swing angular acceleration pa Is generated to set the 

10 antiphase arm swing angular velocity back to the Initial 
angular velocity of a reference antiphase arm swing angle 
trajectory during the period from time Tm to Ts2 and the 
period from time Tm2 to Te. In other words, the floor 
reaction force moment vertical component permissible range 

15 Is sufficiently wide In the period from time Tm to Ts2 and 
the period from time Tm2 to Te, so that the floor reaction 
force moment vertical component Mz does not exceed the 
permissible range even if the antiphase arm swing angular 
acceleration pa is generated to restore the antiphase arm 

20 swing angular velocity. 

After the processing of S316 of Fig. 24 is completed 
as described above, the processing proceeds to S210 of Fig. 
23 wherein the terminal horizontal body position and 
velocity of a generated gait (provisional normal gait) are 

25 converted into values observed from a supporting leg 

coordinate system (the coordinate system of X" ' , Y" ' , and 
Z"' shown in Fig. 17) associated with the supporting leg 



of that particular Instant, and the values are defined as 
(Xe, Vxe)(Xe: Terminal body horizontal position; and Vxe: 
Terminal horizontal body velocity) . 

Subsequently, the processing proceeds to S212 wherein 
the difference between the Initial horizontal body 
position/velocity (Xs, Vxs) and the terminal horizontal 
posit Ion/ velocity (Xe, Vxe) Is calculated, as Illustrated. 
This difference (Xs-Xe, Vxs -Vxe) is referred to as a 
horizontal body position/velocity boundary condition error 
(errx, errvx) • In a normal gait, the boundary condition 
must be satisfied, so that (Xs, Vxs) and (Xe, Vxe) must 
agree. Hence, the horizontal body position/velocity 
boundai^ condition error (errx, errvx) must be zero or 
substantially zero. In the present first reference 
example, (Xs, Vxs) that sets the horizontal body 
position/velocity boundary condition error (errx, errvx) 
to substantially zero is exploratorily determined. 

Subsequently, the processing proceeds to S214 wherein 
it is determined whether the calculated horizontal body 
position/ velocity boundary condition error (errx, errvx) 
falls within the permissible range appropriately set 
beforehand. Instead of setting the permissible range of a 
horizontal body position/velocity boundary condition error 
as described above, it may be determined whether the 
difference between an initial divergent component 
(Xs+Vxs/coO) and a terminal divergent component (Xe+Vxe/coO) 
and the difference between an Initial convergent component 
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(Xs-Vxs/(oO ' ) and a terminal convergent component (Xe- 
Vxe/coO') respectively fall within certain permissible 
ranges. As previously mentioned, (oO and oO' denote 
certain predetermined values. 
5 If the determination result of S214 is NO, then the 

processing proceeds to S216. In this S216, a plurality of 
(two in the present first reference example) initial value 
candidates (Xs + AXs, Vxs) and (Xs, Vxs + AVxs) is 
determined in the vicinity of (Xs, Vxs). Here, AXs and 

10 AVxs mean predetermined minute variation amounts 

associated with Xs and Vxs, respectively. Then, taking 
each of these initial value candidates as an initial state 
of the horizontal body position/velocity, a normal gait is 
generated using gait parameters by the same processing as 

15 that of the above S208. Further, the terminal body 
position/velocity of the generated normal gait are 
converted to obtain values (Xe+AXel, Vxe+AVxel) and 
(Xe+AXe2, Vxe+AVxe2) observed from a supporting leg 
coordinate system (the coordinate system of X"' , Y" ' , and 

20 Z"' shown in Fig. 17) associated with the supporting leg 
at that particular Instant. Here, (Xe+AXel, Vxe+AVxel) 
means the terminal body posit ion/ velocity that corresponds 
to (XsH-AXs, Vxs), and (Xe-i-AXe2, Vxe+AVxe2) corresponds to 
the terminal body position/velocity that corresponds to 

25 (Xs, Vxs+AVxs). In the processing for generating a normal 
gait (provisional gait) in this case, the initial state 
(the state at time Ts) of a variable other than the 
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horizontal body position/velocity may be set to the same 
value as that in a case where, for example, the initial 
value candidate of the horizontal body position/velocity 
is set to (Xs, Vxs). In S216, the same processing as that 
of the above S210 is carried out to determine the 
difference between each initial value candidate and the 
terminal body position/velocity corresponding thereto, 
i.e., the horizontal body position/velocity boundary 
condition error corresponding to each initial value 
candidate (Xs+AXs, Vxs), (Xs, Vxs+AVxs). 

Next, the processing proceeds to S218 wherein, based 
on the horizontal body position/velocity boundary 
condition error corresponding to each of (Xs, Vxs) and the 
initial value candidates in the vicinity thereof (Xs+AXs, 
Vxs), (Xs, Vxs+AVxs), an initial value candidate following 
(Xs, Vxs) is determined by a searching method (a method in 
which a pseudo- Jacoblan (sensitivity matrix) is determined 
and then a next candidate is determined by the steepest 
descent method or the like, or the simplex method or the 
like). More specifically, a sensitivity matrix indicating 
a changing degree of a horizontal body position/velocity 
boundary condition error observed when a horizontal body 
position and a horizontal body velocity are respectively 
changed minutely from the initial value candidate (Xs, 
Vxs) on the basis of the horizontal body position/velocity 
boundary condition errors associated with each of (Xs, 
Vxs) and the initial value candidates in the vicinity 
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thereof (Xs+AXs, Vxs), (Xs, Vxs+AVxs) is determined, and 
then, based on the determined sensitivity matrix, an 
initial value candidate (Xs, Vxs) that will further 
reduces the horizontal body position/velocity boundary 
5 condition error is newly determined. After the new 

initial value candidate (Xs, Vxs) of the horizontal body 
position/velocity is determined as described above, the 
processing returns to S206 . 

The aforesaid processing (the processing from S206 to 

10 S218) is repeated as long as the determination result of 
S214 is NO. In this case, in S300 (refer to Fig. 24) of 
the processing for generating a normal gait corresponding 
to a new initial value candidate (Xs, Vxs) of the 
horizontal body position/velocity (S208), the initial 

15 value of the body posture angular velocity is set to the 
value determined in S3 10 (refer to Fig. 24) in the 
processing of S208 that corresponds to the last time 
initial value candidate (Xs, Vxs) of the horizontal body 
position/velocity rather than being set to the initial 

20 value of the reference body posture angular velocity. And 
if the determination result of S214 is YES, then the 
processing leaves the repetition loop (S204) and proceeds 
to S220. The provisional normal gait generated 
immediately before leaving the repetition loop of S204 

25 will be obtained as the normal gait that satisfies the 
boundary condition. 

In S220, an initial horizontal body position/velocity 
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(XO, VO) at an original Initial time 0 (the end time of 
the current time gait), an initial vertical body 
position/velocity (ZO, VzO) at the initial time 0, and 
initial body posture angle and angular velocity at the 
5 initial time 0 are determined. 

Specifically, (XO, VO) and (ZO, VzO) are determined 
to be the values obtained by converting the horizontal 
body position/velocity and the vertical body position/ 
velocity, which are determined at the time of instant when 

10 a second turning gait is switched to a first turning gait, 
i.e., at time k=Tcyc (time Te-Ts), into the values 
observed from the supporting leg coordinate system (the 
X"', Y" ' , and Z' ' coordinate system of Fig. 17) associated 
with the supporting leg of the first step starting from 

15 time Tcyc (i.e., a second 1st turning gait) in a case 

where a gait is generated to satisfy a gait condition on 
the basis of a body inclination restoring moment ZMP- 
converted value pattern and the initial body posture angle 
and angular velocity of a normal gait at time Ts that have 

20 been determined in S3 10 and the horizontal body 

position/velocity (Xs, Vxs) at time Ts after leaving the 
loop of S204. Similarly, the initial state posture angle 
and angular velocity are determined to be the values 
obtained by converting the body posture angle and angular 

25 acceleration determined when time k=Tcyc (time Te-Ts) into 
values observed from the supporting leg coordinate system 
(the X"', Y"' , and Z coordinate system of Fig. 17) 
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associated with the supporting leg of one step starting 
from time Tcyc (I.e., a second first turning gait). 

Subsequently, the processing proceeds to S222 wherein 
a normal gait Initial divergent component q[0] Is 
5 determined according to the following equation. 

q[0] = XO + VO/coO ... Equation 40 

where coO takes a certain predetermined value, as 
explained above In relation to the divergence. 

10 Subsequently, the processing proceeds to S224 wherein 

the normal gait Initial divergent component q[0] Is 
converted Into a value observed from a current time's gait 
supporting leg coordinate system, and this Is determined 
as q"[0]. Further, the Initial vertical body 

15 position/velocity (ZO, VzO) is converted into a value 
observed from the current time's gait supporting leg 
coordinate system, and this is determined as (ZO", VzO"). 

Supplementally, (ZO", VzO") agrees with the terminal 
vertical body position/velocity of a second turning gait 

20 observed from the supporting leg coordinate system of the 
second turning gait (the X", Y" , and Z" coordinate system 
of Fig. 17). In addition, q"[0] also agrees with the 
terminal divergent component of the second turning gait 
observed from the supporting leg coordinate system of the 

25 second turning gait (the X", Y", and Z" coordinate system 
of Fig. 17). Alternatively, therefore, (ZO", VzO") and 
q"[0] may be calculated by utilizing these properties. 
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The processing further proceeds to S226 wherein 
Initial antiphase arm swing angle and angular velocity 
(6azO, (oazO) at the original Initial time 0 (the end time 
of the current time gait) are determined, and further, 
5 (6azO", <oazO*), which Is the value observed from the 

current time's gait supporting leg coordinate system. Is 
determined. To be more specific, (6azO, coazO) Is 
determined to be the value obtained by converting the 
antiphase arm swing angle and angular velocity, which are 

10 determined at the time of instant when a second turning 
gait is switched to a first turning gait, i.e., at time 
k=Tcyc (time Te-Ts), in a case where a gait is generated 
in such a manner to satisfy a gait condition on the basis 
of an antiphase arm swing restoring angular acceleration 

15 pattern, and initial (time Ts) antiphase arm swing angle 
and angular velocity of a normal gait that have been 
determined in S314 and S316 (more specifically, in a case 
where an antiphase arm swing angle trajectory is 
determined such that a floor reaction force moment 

20 vertical component does not exceed a permissible range in 
a period other than the body posture angle and antiphase 
arm swing angle restoring period, and the antiphase arm 
swing angle trajectory is determined such that the sum of 
the reference antiphase arm swing angular acceleration 

25 Paref and the antiphase arm swing restoring angular 

acceleration parec is generated in the body posture angle 
and antiphase arm swing angle restoring period) , into a 
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value observed from the supporting leg coordinate system 
(the X" , Y"', and Z"' coordinate system of Fig. 17) 
associated with the supporting leg of one step starting 
from time Tcyc (i.e., a second 1st turning gait). 
5 Thus, the processing of S024 of Fig. 13, that is, the 

subroutine processing for determining an initial state of 
a normal gait, is finished. 

Subsequently, the processing proceeds to S026 of Fig. 
13 wherein the gait parameters of the current time gait 
10 are determined (some are provisionally determined). To be 
more specific, in S026, the following processing is 
carried out according to the flowchart shown in Fig. 39. 

First, in S600, the foot trajectory parameters of the 
current time gait are set such that the foot 
15 position/posture trajectory of the current time gait 

continues to the foot position/posture trajectory of a 
normal gait. 

Specifically, the initial free leg foot 
position/posture of the current time gait (the initial 
20 value of the free leg foot position/posture of the current 
time gait) is set to current free leg position/posture 
observed from the current time's gait supporting leg 
coordinate system (the terminal free leg position/posture 
of the last time gait ) . The initial supporting leg foot 
25 position/posture of the current time gait (the initial 
value of the current time's gait supporting leg foot 
position/posture) are set to current supporting leg foot 
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position/posture observed from the current time's gait 
supporting leg coordinate system (the terminal supporting 
leg foot position/posture of the last time's gait). The 
terminal free leg foot position/posture of the current 
5 time gait Is determined on the basis of a next time's gait 
supporting leg coordinate system observed from the current 
time's gait supporting leg coordinate system (a required 
value of the free leg landing position/posture of the 
first step related to the current time gait). More 

10 specifically, the terminal free leg foot position/posture 
of the current time gait are determined such that a 
representative point of a free leg foot 22 agrees with the 
origin of the next time's gait supporting leg coordinate 
system observed from the current time's gait supporting 

15 leg coordinate system when the free leg foot 22 is turned, 
from the terminal free leg foot position/posture of the 
current time gait, until substantially the entire surface 
of the sole of the foot 22 comes in contact with the 
ground without slippage, while maintaining the free leg 

20 foot 22 in contact with a floor. 

At the end of the current time gait, the supporting 
leg foot 22 is off the floor and floating. To determine 
the trajectory after the supporting leg foot 22 leaves the 
floor, an expected supporting leg foot landing 

25 position/posture is set. The expected supporting leg foot 
landing position/posture is set on the basis of the next 
but one time's gait supporting leg coordinate system 
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observed from the current time's gait supporting leg 
coordinate system (a required value of the free leg foot 
position/posture of the second step related to the current 
time gait). To be more specific, the expected supporting 
5 leg foot landing position/posture are determined such that 
a representative point of the foot 22 obtained when the 
foot 22 Is turned from that position/posture without 
slippage until substantially entire surface of the sole of 
the foot 22 Is brought Into contact with the floor while 
10 holding the foot 22 in contact with the floor agrees with 
the origin of the next but one time's gait supporting leg 
coordinate system obseirved from the current time's gait 
supporting leg coordinate system. 

The terminal supporting leg foot position/posture of 
15 the current time gait is determined by generating a foot 
position/posture trajectory from a current supporting leg 
position/posture (the initial supporting leg foot 
position/posture of the current time gait) to the expected 
foot landing position/posture corresponding to the next 
20 time's gait supporting leg coordinate system (the required 
value of the free leg foot landing position/posture of the 
second step in the aforesaid required parameter) by using 
the finite-duration setting filter until the end of the 
current time gait. 
25 Subsequently, the processing proceeds to S602 wherein 

the reference body posture trajectory parameter of the 
current time gait is determined in the same manner as that 
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for the first turning gait and the second turning gait of 
a normal gait. The aforesaid parameter, however, is set 
such that the reference body posture trajectory of the 
current time gait continuously connects to the reference 
5 body posture trajectory of the above normal gait (such 
that the reference body posture angle and the angular 
velocity at the end of the current time gait agree with 
the reference body posture angle and the angular velocity, 
respectively, at the start of a normal gait). In the 
10 present first reference example, the reference body 

posture related to an inclination angle refers to a steady 
vertical posture in both a current time gait and a normal 
gait. 

Next, the processing proceeds to S604 wherein the 
15 reference arm posture trajectory parameters of the current 
time gait are determined in the same manner as that for 
the first turning gait and the second turning gait of the 
normal gait. The above parameters, however, are set such 
that the initial reference arm posture of the current time 
20 gait and the changing rate thereof agree with the current 
instantaneous values of a reference arm posture and the 
changing rate thereof, and the arm posture trajectory of 
the current time gait continuously connects with the arm 
posture trajectory of the normal gait. For the arm 
25 posture trajectory parameters determined here, the 

parameters related to, for example, a total center-of- 
gravity position of both arms 5, 5 (a relative position 
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with respect to the body 3 ) , a lateral Interval between 
right and left hands (the distal ends of both arms 5, 5), 
and an antiphase arm swing angle are determined, as in the 
case where the normal gait parameters are determined (S104 
in Fig. 15). In the present first reference example, the 
total center- of -gravity position of both arms 5, 5 is set 
so as to be maintained at a constant level with respect to 
the body 3. 

The processing then proceeds to S606 wherein the 
floor reaction force vertical component trajectory 
parameters of the current time gait are determined such 
that the floor reaction force vertical component 
trajectory defined by the parameters will be a 
substantially continuous (values not jumping in steps) 
trajectory as illustrated in Fig. 6 mentioned above, as in 
the case of the first turning gait and the second turning 
gait of a normal gait. 

The floor reaction force vertical component 
trajectory parameters, however, are determined such that 
both the total center- of -gravity vertical 
position/velocity and the floor reaction force vertical 
component trajectory of the current time gait continuously 
connect with the normal gait. 

To be specific, first, the value (ZO", VzO") obtained 
by converting the initial vertical body position/velocity 
of the normal gait that has been finally determined by the 
processing of S024 of Fig. 13 mentioned above (the 



- 159 - 



processing for determining the Initial state of the normal 
gait) Into the value observed from a current time's gait 
supporting leg coordinate system. I.e., the Initial total 
center-of-gravlty vertical position/velocity of the normal 
gait observed from the current time's gait supporting leg 
coordinate system are determined using, for example, the 
above Equation 04 (or a kinematics model of the robot 1) 
on the basis of (ZO", VzO") or the like determined In S224 
of Fig. 23. To be more specific, the Initial total 
center-of-gravlty vertical position of the normal gait 
observed from the current time's gait supporting leg 
coordinate system Is determined by substituting the body 
mass point vertical position of the model shown In Fig. 12, 
which corresponds to the vertical body position ZO" of the 
normal gait determined In S224, and the leg mass point 
vertical positions of a supporting leg and a free leg, 
which correspond to the values obtained by converting 
Individual foot positions at the start of the normal gait 
Into the values observed from the current time's gait 
supporting leg coordinate system. Into Equation 04. 
Further, the Initial total center-of-gravlty vertical 
velocity of the normal gait observed from the current 
time's gait supporting leg coordinate system is determined 
by substituting the body mass point vertical velocity of 
the model shown in Fig. 12, which corresponds to the body 
vertical velocity VzO" of the normal gait determined in 
S224, and the leg mass point vertical velocities of a 
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supporting leg and a free leg, which correspond to the 
values obtained by converting individual foot vertical 
velocities at the start of the normal gait Into the values 
observed from the current time's gait supporting leg 
coordinate system. Into an equation derived from 
differentiating both sides of Equation 04. Alternatively, 
the initial total center-of -gravity vertical 
position/velocity may be calculated by using a more 
precise model. 

Then, the initial total center -of -gravity vertical 
position/velocity of the normal gait determined as 
described above are substituted into the terminal total 
center- of -gravity vertical positions /velocities of the 
following equations 41a and 41b, and the total center- of - 
gravity vertical position and velocity of the last time 
desired gait instantaneous value (to be more precise, the 
value obtained by converting the terminal state of the 
last time desired gait into the current time's supporting 
leg coordinate system) are substituted into the initial 
total center- of -gravity vertical positions and velocities 
of Equations 41a and 41b. Then, a floor reaction force 
vertical component pattern (to be more specific, a 
parameter value) of the current time gait is determined 
such that the relationship between Equations 41a and 41b 
is satisfied. The integrated values in Equations 41a and 
41b are to be the integrated values in the period from the 
start to the end of the current time gait. 
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Terminal total center- of -gravity vertical position - 
Initial total center-of -gravity vertical position 
= Second order integration of (Floor reaction force 
vertical component / Total mass of the robot) 
+ Second order integration of acceleration of gravity 
+ Initial total center-of -gravity vertical velocity * 
Duration of one step 

... Equation 41a 

Terminal total center-of -gravity vertical velocity - 
Initial total center-of -gravity vertical velocity 
= First order integration of (Floor reaction force 
vertical component / Total mass of the robot) 
+ First order integration of gravity acceleration 

... Equation 41b 

where the gravity acceleration takes a negative value. 

To be more specific, first, at least two parameters 
out of the floor reaction force vertical component 
parameters (e.g., times of break points) that define the 
floor reaction force vertical component pattern as shown 
in Fig. 6 are taken as independent unknown variables. The 
values of the unknown variables are determined by solving 
a simultaneous equation composed of Equations 41a and 41b. 

The floor reaction force vertical component 
parameters to be selected as the unknown variables may be. 
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for example, the height (the peak value of the floor 
reaction force vertical component) and the width (duration 
of single stance period) of the trapezoid shown in Fig. 6. 
In this case, the slopes of both sides of the trapezoid 
5 shown in Fig. 6 takB values determined beforehand on the 
basis of a current time gait cycle or the like, or the 
values of times of the break points of the floor reaction 
force vertical component pattern, excluding the time at 
which a single stance period is switched to a floating 

10 period, that has been determined beforehand on the basis 

of a current time gait cycle or the like. Supplementally, 
if only one unknown variable is given, then no solution 
generally exists that satisfies the simultaneous equation 
of Equations 41a and 41b. 

15 Subsequently, the processing proceeds to S608 wherein 

a floor reaction force horizontal component permissible 
range [Fxmin, Fxmeix] (to be more specific, the parameters 
defining the pattern of the floor reaction force 
horizontal component permissible range) is set in the same 

20 manner as that for the first turning gait and the second 
turning gait of a normal gait. For instance, the floor 
reaction force horizontal component permissible range is 
set according to the pattern shown in Fig. 40. In the 
present first reference example, the floor reaction force 

25 horizontal component pexnnissible range is set according to 
the aforesaid Equation 12 on the basis of the floor 
reaction force vertical component pattern determined 
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previously In S606. 

Then, the processing proceeds to S610 wherein a floor 
reaction force moment vertical component permissible range 
[Mzmin, Mzmax] (to be more specific, the pareuneters 
defining the pattern of the floor reaction force moment 
vertical component permissible range) is set in the same 
manner as that for the first turning gait and the second 
turning gait of a normal gait. For instance, the floor 
reaction force moment vertical component permissible range 
is set according to the pattern shown in Fig. 41. In the 
present first reference example, the floor reaction force 
moment vertical component permissible range is set 
according to the aforesaid Equation 1012 on the basis of 
the floor reaction force vertical component pattern 
determined previously in S606. 

Subsequently, the processing proceeds to S612 wherein 
the ZMP trajectory of the current time gait (specifically, 
the parameters defining the ZMP trajectory, such as times 
and positions of break points of the trajectory) is set, 
as shown in Fig. 7, such that it exhibits a high stability 
margin and no sudden changes, as in the first turning gait 
and the second turning gait of a normal gait. The 
parameters are set such that the ZMP trajectory of the 
current time gait continuously connects with the ZMP 
trajectory of the aforesaid normal gait. In other words, 
the ZMP trajectory parameters are determined so that the 
ZMP position at the end of the current time gait agrees 
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with the ZMP position at the start of the normal gait. In 
this case, in a running gait, the times and positions of 
break points of the ZMP trajectory in a single stance 
period may be set in the same manner as that for setting 
5 the ZMP trajectory parameters of the normal gait described 
above. And the ZMP trajectory parameters may be set so 
that a desired ZMP trajectory in a floating period 
linearly changes in succession from the start of the 
floating period to the ZMP position at the start of a 

10 normal gait. 

It should be noted that the ZMP trajectory parameters 
of the current time gait determined in S612 are merely 
temporary, and will be corrected, as it will be discussed 
hereinafter. For this reason, the ZMP trajectory of the 

15 current time gait set as described above will be 

hereinafter referred to as a provisional desired ZMP 
trajectory of a current time gait. 

Lastly, the processing proceeds to S614 wherein a 
body posture angle and antiphase arm swing angle restoring 

20 period [Ta, Tb] is set. The body posture angle and 
antiphase arm swing angle restoring start time Ta 
corresponds to Tm in the second turning gait of a normal 
gait, while body posture angle and antiphase arm swing 
angle restoring end time Tb corresponds to Ts2 in the 

25 second turning gait of the normal gait. These times Ta 
and Tb are set in the same manner as that for setting Tm 
and Ts2. 
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Returning to the explanation of Fig. 13, after 
carrying out the processing shown in S026 (the processing 
for determining the gait parameters of the current time 
gait) as described above, the processing proceeds to S028 
5 wherein the gait parameters (ZMP trajectory parameters) of 
the current time gait are corrected, and the parameter of 
the antiphase arm swing angle is determined. In this 
processing, the ZMP trajectory parameters are corrected so 
as to make the body position/posture trajectory continue 

10 or approximate to a normal gait, and a parameter related 
to the antiphase arm swing angle of the current time gait 
is determined to make the antiphase arm swing angle 
converge to the antiphase arm swing angle trajectory of 
the normal gait . 

15 Fig. 42 shows the subroutine flowchart illustrating 

the processing. 

First, the processing proceeds to S702 via S700 and 
temporarily generates a provisional current time gait 
until the time at which the current time gait ends on the 

20 basis of a provisional desired ZMP pattern and other 
current time gait pareuneters. 

In S702, the following processing will be carried out 
according to the flowchart shown in Fig. 43. 

The explanation will now be given. In S800, various 

25 elements are initialized. Specifically, zero is 

substituted into time k for generating a provisional gait. 
Furthermore, the initial state of the current time gait is 
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obtained by converting the terminal state of the last time 
desired gait (to be more specific, the terminal values of 
the gait states, including a horizontal body 
position/ velocity, a vertical body posit ion/ velocity , a 
5 body posture angle and its angular velocity, a desired 

foot position/posture, and a desired arm posture) into a 
current time's supporting leg coordinate system. 

Supplementally, the desired arm posture includes 
desired antiphase arm swing angle and angular velocity • 

10 Subsequently, the processing goes through S802 and 

proceeds to S804 wherein it is determined whether time k 
for generating a provisional gait is before current time 
gait end time Tcurr (whether k s Tcurr) . If the 
determination result is YES, then the processing proceeds 

15 to a current time gait instantaneous value determining 

subroutine of S806 to determine an instantaneous value of 
time k of the current time gait« In the gait 
instantaneous value determining subroutine of S806, a 
provisional gait is generated as shown in Fig, 25 in the 

20 same manner as that of S306 previously described. However, 
current time gait parameters are used in place of normal 
gait parameters , as the gait parameters . 

Subsequently, the processing proceeds to S808 to 
increment time k for generating a provisional gait by Ak, 

25 and then returns to S804. 

If the determination result of S804 is NO, then the 
processing of the flowchart shown in Fig. 43 is completed. 
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The processing discussed above generates the 
provisional current time gait from the start and the end 
thereof . 

Subsequently, the processing proceeds to S704 wherein 
a terminal divergent component qO[k] (k=Tcurr) Is 
determined according to the equation shown In the figure 
(Equation 10 given above) from the horizontal body 
position/velocity (Xe, Vxe) at the end of the current time 
gait determined In S702 as described above. 

The proceeding then proceeds to S706 wherein a 
terminal divergent component error errq, which Is the 
difference between a current time gait terminal divergent 
component qO[k] and a normal gait Initial divergent 
component q" (the one determined In S224 of Fig. 23), is 
determined using the equation shown. Further, the 
processing proceeds to S708 wherein it is determined 
whether the determined terminal divergent component error 
errq falls within a permissible range (a range in the 
vicinity of zero). 

If the determination result of S708 is NO, then the 
processing proceeds to S710 wherein a = Aa (Aa being a 
predetermined extremely small amount) is set, and a 
provisional current time gait to the end thereof is 
calculated, as in the aforesaid S702, on the basis of the 
desired ZMP obtained by adding a trapezoidal correction to 
the current provisional desired ZMP pattern according to 
the relationship shown in Fig. 44. Here, referring to Fig. 



- 168 - 



44, "a" denotes the height of the trapezoidal pattern for 
correcting a provisional desired ZMP so as to make the 
current time gait terminal divergent component agree with 
the normal gait initial divergent component as much as 
5 possible (so as to approximate the horizontal body 

position/posture trajectory of the current time gait to 
the horizontal body position/posture trajectory of the 
normal gait). In this case, in the present first 
reference example, the provisional desired ZMP is 

10 corrected during the period in which substantially the 

entire surface of the sole of the supporting leg foot 22 
comes in contact with the ground (the entire-sole-in- 
contact-with-the-ground period), that is, during the 
period in which the floor reaction force horizontal 

15 component permissible range is sufficiently wide, and the 
times of the break points of the above trapezoidal pattern 
are set to balance with the times of the break points of 
the provisional desired ZMP in the entire-sole-in-contact- 
with- the -ground period. The setting a-Aa is given in S710 

20 to observe a change in the terminal divergent component 
error errq when the current provisional desired ZMP 
trajectory is corrected by an extremely small amount 
according to the aforesaid trapezoidal pattern. 

After generating the provisional current time gait to 

25 the end with the provisional desired ZMP trajectory 
corrected using a=Aa in S710 as described above, the 
processing further proceeds to S712 wherein a terminal 
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divergent component ql[k] In this provisional current time 
gait is determined according to the equation shown in the 
figure (the above Equation 10) on the basis of a 
horizontal body position/velocity (Xel, Vxel) at the end 
5 of the provisional current time gait determined in S710. 

In S710, Aa has been a constant of an extremely small 
amount appropriately set in the present first reference 
example. Alternatively, Aa may be set such that Aa 
decreases as the terminal divergent component error errq 

10 is decreased by repeated calculation, which will be 

explained below. However, even if it is set as a constant, 
it is possible to maintain the terminal divergent 
component error errq within a permissible range by 
performing a few repetitive calculations. 

15 Subsequently, the processing proceeds to S714 wherein 

a parameter sensitivity r (changing rate of the terminal 
divergent component error relative to Aa) is determined 
according to the equation shown in the figure. The 
processing further proceeds to S716 wherein the correction 

20 amount of the trapezoidal pattern having, as its height a, 
the value obtained by a=-errq/r, that is, the value 
obtained by dividing the terminal divergent component 
error errq determined in S706 by the pareuneter sensitivity 
r determined in S714, is added to the provisional desired 

25 ZMP pattern according to the relationship shown in Fig. 44, 
thereby correcting the provisional desired ZMP pattern (a 
new provisional desired ZMP pattern is determined) • 
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Then, the processing returns to S702. As long as the 
determination result of S708 Is NO, the processing from 
S702 to S716 described above is repeated • When the 
determination result of S708 changes to YES, the 
processing leaves the repetition loop (S700) and moves 
forward to S718, 

In S718, the pattern of the body posture restoring 
moment ZMP- converted value (ZMPrec) of the current time 
gait is determined on the basis of mainly the difference 
between a terminal body posture angle of the provisional 
current time gait and an initial body posture angle of a 
normal gait, and the difference between a terminal body 
posture angular velocity of the provisional current time 
gait and an Initial body posture angular velocity of a 
normal gait such that the body posture angle trajectory of 
the current time gait approximates the body posture angle 
trajectory of the normal gait. The ZMPrec determined here 
is used for correcting a provisional desired ZMP so that 
the agreement between the terminal divergent component of 
the current time gait and the initial divergent component 
of the normal gait (the condition in S708) may be 
maintained even when a body posture angular acceleration 
is generated to connect (bring close) the body posture 
angle trajectory to the normal gait in the period, wherein 
the floor reaction force horizontal component permissible 
range becomes sufficiently wide (the duration in a single 
stance period) , by the processing for generating a current 



- 171 - 



time gait instantaneous value, which will be described 
hereinafter . 

The ZMPrec exhibits a trapezoidal pattern similar to 
that explained in relation to the processing for 
5 generating the normal gait. To be more precise, the 

ZMPrec is determined as follows. The trapezoidal pattern 
of the ZMPrec of the current time gait is set in the scune 
manner as that for the trapezoidal pattern of the ZMPrec 
in the period of the second turning gait shown in Fig. 30, 

10 the times (break points) of apexes of the trapezoid being 
known (more specifically, the times of the break points of 
the trapezoid are matched with the break point times of 
the desired ZMP), and the height of the trapezoid 
(parameter) of the ZMPrec is determined as described below, 

15 taking the height of the trapezoid as an unknown niimber. 
In this case, the time at which the trapezoid pattern of 
the ZMPrec begins to rise is denoted by Ta, and the time 
at which the trapezoid pattern returns to zero is denoted 
by Tb. 

20 It is usually impossible to continuously connect both 

body posture angle and body posture angular velocity to a 
normal gait at the end of the current time gait if there 
is only one unknown parameter of the body posture 
restoring moment ZMP-converted value pattern as described 

25 above. For this reason, in the present first reference 
example, an unknown pareimeter is determined so that the 
state of a gait generated gradually approximates the state 
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of a normal gait over a plurality of steps. 

Supplementally, the ZMPrec pattern In a single gait 
may be complicated to produce two or more unknown 
parameters to continuously connect both the body posture 
5 angle and the body posture angular velocity to the normal 
gait at the end of the current time gait. This, however, 
may lead to a ZMPrec pattern with excessive staggered 
variation. 

The following will explain the principle of 

10 calculation and then the procedure of the calculation. 

As previously described, the difference between the 
terminal body posture angle of the provisional current 
time gait that has been determined with the height of the 
trapezoid of the ZMPrec pattern being zero in S702 as 

15 discussed above and the initial body posture angle of the 
normal gait is deteznnined, and the determined difference 
is denoted by Berr. Further, the difference between the 
terminal body posture angular velocity of the provisional 
current time gait and the initial body posture angular 

20 velocity of the normal gait is determined, and the 
determined difference is denoted by v9err. 

Here, it is assumed that the current time gait is 
generated, setting the height of the trapezoid of the 
ZMPrec pattern as a certain value bcurr, and then the 

25 first turning gait is generated by the same algorithm as 
that of the current time gait. It is assumed that the 
body posture restoring moment ZMP- converted value ZMPrec 
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pattern of the first turning gait is based on the sum of 
the ZMPrec pattern of the first turning gait (the 
trapezoidal pattern shown in Fig. 30, the height of which 
is acycl as mentioned above), determined in S310 of Fig. 
5 24 and a certain value bl. 

The gait generated as described above is referred to 
as a ZMPrec corrected gait, and its terminal (the end of 
the first turning gait) body posture angle and angular 
velocity are denoted by 91 and v61, respectively. 

10 The terminal body posture angle and angular velocity 

of the first turning gait are denoted by Olorg and vOlorg, 
respectively, of the original normal gait determined at 
the point when the subroutine processing for determining 
the initial state of the normal gait in S024 is completed 

15 (the normal gait in a case where the initial body posture 
angle and angular velocity of the normal gait finally 
determined in S310 are taken as the initial values, and 
the ZMPrec pattern is the pattern determined in S310 (the 
trapezoidal pattern shown in Fig. 30, the height thereof 

20 being acycl) ) . 

Here, AOl and AvOl are defined as follows: 

ABl = ei - eiorg ... Equation 50 

AvOl = vei - veiorg ... Equation 51 

25 

Aei and Av9l mean the differences in body posture 
angle and angular velocity, respectively, between the 
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corrected ZMPrec gait and the original normal gait at the 
point when these two gaits have been generated to the end 
of the first turning gait. If AQl and AvSl are zero, then 
the second turning gait generated according to the same 
5 algorithm as that of the current time gait, setting the 
height of the trapezoid of the ZMPrec pattern as acyc2 , 
and following the corrected ZMPrec gait, will agree with 
the original normal gait. 

Thus, the height bcurr of the trapezoid of the 

10 current time gait and the height bl of the trapezoid of 
the first turning gait at which AQl and AvOl reach zero 
may be determined, and the determined bcurr may be taken 
as the finally determined height of the trapezoid of the 
current time gait . 

15 The dynamic model related to the body posture angle 

of the robot 1 has the linear characteristic represented 
by flywheels FHx and FHy shown in Fig. 12. Hence, AQl and 
Avei share the relationships shown below with the height 
bcurr of the trapezoid of the current time gait, the 

20 height bl of the trapezoid of the first turning gait, the 
difference Gerr between the terminal body posture angle of 
the provisional current time gait and the initial body 
posture angle of the normal gait, and the difference vOerr 
between the terminal body posture angular velocity of the 

25 provisional current time gait and the Initial body posture 
angular velocity of the normal gait. 
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A81 = cll*bcurr+cl2*bl+0err+el*v9err ... Equation 52 
Avei = C21*bcurr+c22*bl+e2*veerr ... Equation 53 

where cll, cl2, c21, c22, el, and e2 are coefficients 
uniquely determined primarily by a current time gait and 
the gait cycle of a first turning gait, and the parameters 
(particularly the parameters related to time) of a body 
posture restoring moment ZMP-converted value ZMPrec 
pattern. 

Based on the aforementioned principle, the 
calculation procedure first determines the body posture 
angle difference Serr and the angular velocity difference 
veerr in the boundary between the provisional current time 
gait and the normal gait. 

Then, the coefficients cll, cl2, c21, c22, el, and e2 
of Equations 52 and 53 are determined primarily on the 
basis of the gait cycles of a current time gait and a 
first turning gait and the parameters (particularly the 
parameters related to time) of a body posture restoring 
moment ZMP-converted value ZMPrec pattern. 

Next, the height bcurr of the trapezoid of the 
current time gait and the height bl of the trapezoid of 
the first turning gait are determined such that the right 
sides of Equations 52 and 53 become zero. In other words, 
bcurr and bl are determined by solving the simultaneous 
equation having the left sides of Equation 52 and Equation 
53 set to zero. 
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Lastly, the height of the trapezoid of the 
trapezoidal pattern of the body posture restoring moment 
ZMP-converted value (ZMPrec) of the current time gait is 
set to the height bcurr of the trapezoid of the above 
determined current time gait. 

Subsequently, the processing proceeds to S720 wherein 
the pattern obtained by adding the body posture restoring 
moment ZMP-converted value pattern determined as described 
above in S718 to the current provisional desired ZMP 
pattern (the provisional desired ZMP pattern when the 
processing leaves the repetition loop of S700) is 
determined as the desired ZMP pattern of the current time 
gait. This processing is the same as the processing for 
adding the trapezoidal pattern having the height of Aa in 
S710 to the provisional desired ZMP pattern. 

The following will describe the reason for adding the 
body posture restoring moment ZMP-converted value pattern 
to the provisional desired ZMP pattern. 

The provisional current time gait generated in the 
loop of S700 is generated by setting the body posture 
restoring moment ZMP-converted value ZMPrec to zero (by 
setting the height parameter of the trapezoidal pattern of 
ZMPrec to zero). In the provisional current time gait 
finally generated in the loop of S700, the body 
position/velocity continues to or approximates a normal 
gait, whereas the body posture angle deviates from the 
body posture angle of the normal gait and undesirably 
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diverts In some cases. 

The body posture restoring moment ZMP-converted value 
pattern determined In S718 Is used to generate a body 
posture angular acceleration for approximating a deviation 
of a body posture angle with respect to a normal gait to 
zero. 

If, however, a body posture angular acceleration 
based on the body posture restoring moment ZMP-converted 
value pattern determined In S718 Is generated without 
correcting the provisional desired ZMP pattern finally 
obtained In the loop of S700, then the horizontal body 
position trajectory has to be deviated from a horizontal 
body position trajectory of the above provisional current 
time gait In order to satisfy the dynamic balance 
condition (the moment In which the resultant force of the 
gravity and the Inertlal force of the robot acting on the 
desired ZMP, excluding a vertical component. Is zero). 
For this reason. In the present embodiment, the 
provisional desired ZMP pattern Is corrected by ZMPrec In 
order to obviate the need for shifting the horizontal body 
position trajectory from the one finally obtained In the 
loop of S700. 

If a body posture angular acceleration based on the 
body posture restoring moment ZMP-converted value pattern 
determined In S718 Is generated In addition to the motion 
of the above provisional current time gait, then the ZMP 
(the point at which the moment of the resultant force of 
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the gravity and the Inert ial force, excluding vertical 
component, produced by a motion reaches zero) deviates by 
the body posture restoring moment ZMP-converted value. 
Conversely, therefore, by using the pattern , which is 
obtained by adding the body posture restoring moment ZMP- 
converted value pattern to a provisional desired ZMP 
pattern, as a desired ZMP pattern, the same body 
trans latlonal motion as that of the above provisional 
current time gait can be obtained by generating the 
current time gait that satisfies the desired ZMP pattern 
while generating a body posture angular acceleration of 
the body inclination mode based on the body posture 
restoring moment ZMP-converted value pattern determined in 
S718. 

The above is the reason why the pattern obtained by 
adding the body posture restoring moment ZMP-converted 
value pattern to the provisional desired ZMP pattern is 
used as the desired ZMP pattern. 

Subsequently, the processing proceeds to S722 wherein 
an antiphase aorm swing restoring angular acceleration 
pattern is determined such that the antiphase arm swing 
angle trajectory of a current time gait approximates to 
the antiphase arm swing angle trajectory of a normal gait 
on the basis of the difference between the terminal 
antiphase arm swing angle of the provisional current time 
gait and the initial antiphase arm swing angle of the 
normal gait and the difference between the terminal 



- 179 - 



antiphase arm swing angular velocity of the provisional 
current time gait and the initial antiphase arm swing 
angular velocity of the normal gait. The method for 
determining the pattern is almost the seune as the method 
for determining the body posture restoring moment ZMP- 
converted value pattern in S718, except that variable 
names are different as shown below: 

Body posture restoring moment ZMP- converted value pattern 

Antiphase arm swing restoring angular acceleration 
pattern 

Horizontal component Moment vertical component 

This will be explained in detail below. The 
antiphase arm swing restoring angular acceleration pattern 
to be determined here is used in the processing for 
generating a current time gait Instantaneous value, which 
will be discussed hereinafter, to make a correction so as 
to connect (approximate) the antiphase arm swing angle 
trajectory to the normal gait in the period wherein the 
floor reaction force moment vertical component permissible 
range becomes sufficiently wide (a duration in a single 
stance period) . 

The antiphase arm swing restoring angular 
acceleration pattern is a trapezoidal pattern similar to 
that explained in relation to the processing for 
generating a normal gait. To be more precise, the 
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antiphase arm swing restoring angular acceleration pattern 
Is determined as follows. The trapezoidal pattern of the 
antiphase arm swing restoring angular acceleration of the 
current time gait Is set In the same manner as that for 
the trapezoidal pattern of the antiphase arm swing 
restoring angular acceleration pattern in the period of 
the second turning gait shown In Fig. 36, the times (break 
points) of apexes of the trapezoid being known (more 
specifically, the times of the break points of the 
trapezoid are matched to the break point times of the 
desired ZMP), and the height of the trapezoid (parameter) 
of the antiphase arm swing restoring angular acceleration 
is determined as described below, taking the height of the 
trapezoid as an unknown number. In this case, the time at 
which the trapezoid pattern of the antiphase arm swing 
restoring angular acceleration begins to rise is denoted 
by Ta, and the tdLme of return to zero from the trapezoid 
pattern is denoted by Tb. 

It is usually impossible to continuously connect both 
antiphase arm swing angle and antiphase arm swing angular 
velocity to a normal gait at the end of the current time 
gait if there is only one unknown parameter of the 
antiphase arm swing restoring angular acceleration pattern. 
For this reason, in the present first reference example, 
an unknown parameter is determined so that the state of a 
gait generated gradually approximates the state of a 
normal gait over a plurality of steps. 
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Supplementally, the antiphase arm swing restoring 
angular acceleration pattern in a single gait may be 
complicated to produce two or more unknown pareimeters so 
as to continuously connect both the antiphase arm swing 
angle and antiphase arm swing angular velocity to the 
normal gait at the end of the current time gait. This, 
however, may lead to an antiphase arm swing restoring 
angular acceleration pattern with excessive staggered 
variation . 

As previously described, the difference between the 
terminal antiphase arm swing angle of the provisional 
current time gait that has been determined with the height 
of the trapezoid of the antiphase arm swing restoring 
angular acceleration pattern set to zero in S702, as 
discussed above, and the initial antiphase arm swing angle 
of the normal gait is determined, and the determined 
difference is defined as Gazerr. Further, the difference 
between the terminal antiphase arm swing angular velocity 
of the provisional current time gait and the initial 
antiphase arm swing angular velocity of the normal gait is 
determined, and the determined difference is denoted by 
vBzerr • 

Here, it is assumed that the current time gait is 
generated, setting the height of the trapezoid of the 
antiphase arm swing restoring angular acceleration pattern 
to a certain value bzcurr, and then the first turning gait 
is generated by the same algorithm as that of the current 
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time gait. It Is assumed that the antiphase arm swing 
restoring angular acceleration pattern of the first 
turning gait Is based on the sum of the antiphase arm 
swing restoring angular acceleration pattern (the 
trapezoidal pattern shown In Fig. 36, the height of which 
Is azcycl as mentioned above), determined In S314 of Fig. 
24 and a certain value bzl. 

The gait generated as described above Is referred to 
as an antiphase arm swing restoring angular acceleration 
corrected gait, and Its end (the end of the first turning 
gait) antiphase arm swing angle and angular velocity are 
denoted by Qzl and v9zl, respectively. 

The terminal antiphase arm swing angle and angular 
velocity of the first turning gait are denoted by 9zlorg 
and vBzlorg, respectively, of the original normal gait 
determined at the point when the subroutine processing for 
determining the initial state of the normal gait in S024 
is completed (the normal gait in a case where the 
antiphase arm swing angle and angular velocity at the 
start of the normal gait finally determined in S3 14 are 
taken as the initial values, and the antiphase arm swing 
restoring angular acceleration pattern is the pattern 
determined in S3 14 (the trapezoidal pattern shown in Fig. 
36, the height thereof being azcycl)). 

Here, A9zl and AvSzl are defined as follows: 

AOzl = ezl - Ozlorg ... Equation 1050 
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Avezl = vSzl - vOzlorg ... Equation 1051 

ASzl and AvGzl mean the differences in antiphase arm 
swing angle and angular velocity, respectively, between 
the corrected antiphase arm swing restoring angular 
acceleration gait and the original normal gait at the 
point when these two gaits have been generated to the end 
of the first turning gait. If ABzl and AvOzl are zero, 
then the second turning gait generated according to the 
same algorithm as that of the current time gait, setting 
the height of the trapezoid of the antiphase arm swing 
restoring angular acceleration pattern as azcyc2, and 
following the corrected antiphase arm swing restoring 
angular acceleration gait, will agree with the original 
normal gait. 

Thus, the height bzcurr of the trapezoid of the 
current time gait and the height bzl of the trapezoid of 
the first turning gait at which AOzl and Av0zl reach zero 
may be determined, and the determined bzcurr may be taken 
as the finally determined height of the trapezoid of the 
current time gait. 

The dynamic model related to the antiphase arm swing 
angle of the robot 1 has the linear characteristic 
represented by a flywheel FHaz shown in Fig. 12. Hence, 
ABzl and AvBzl share the relationships shown below with 
the height bzcurr of the trapezoid of the current time 
gait, the height bzl of the trapezoid of the first turning 
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gait, the difference Szerr between the terminal antiphase 
arm swing angle of the provisional current time gait and 
the Initial antiphase arm swing angle of the normal gait, 
and the difference vSzerr between the terminal antiphase 
arm swing angular velocity of the provisional current time 
gait and the Initial antiphase arm swing angular velocity 
of the normal gait. 

AQzl « czll*bzcurr+czl2*bzl+9zerr+ezl*v62err 

... Equation 1052 

AvBzl = cz21*bzcurr+cz22*bzl+ez2*vezerr 

... Equation 1053 

where czll, czl2, cz21, cz22, ezl, and e22 are 
coefficients uniquely determined primarily by a current 
time gait, the gait cycle of a first turning gait, and the 
parameters (particularly the parameters related to time) 
of an antiphase arm swing restoring angular acceleration 
pattern. 

Based on the aforementioned principle, the 
calculation procedure first determines the antiphase arm 
swing angle difference Bzerr and the angular velocity 
difference VSzerr in the boundary between the provisional 
current time gait and the normal gait. 

Then, the coefficients czll, czl2, cz21, cz22, ezl, 
and ez2 of Equations 1052 and 1053 are determined 
primarily on the basis of the gait cycles of a current 
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time gait and a first turning gait and the parameters 
(particularly the parameters related to time) of an 
antiphase arm swing restoring angular acceleration pattern. 

Next, the height bzcurr of the trapezoid of the 
current time gait and the height bzl of the trapezoid of 
the first turning gait are determined such that the right 
sides of Equations 1052 and 1053 become zero. In other 
words, bzcurr and bzl are determined by solving the 
simultaneous equation having the left sides of Equation 
1052 and Equation 1053 set to zero. 

Lastly, the height of the trapezoid of the 
trapezoidal pattern of the antiphase arm swing restoring 
angular acceleration of the current time gait is set to 
the height bzcurr of the trapezoid of the above determined 
current time gait. 

Returning to Fig. 13, after the current time gait 
parameters are corrected in S028 described above or if the 
determination result in S016 is NO, then the processing 
proceeds to S030 to determine a current time gait 
instantaneous value. 

In S030, the subroutine processing shown in Fig. 45 
is carried out . 

The same processing as that from S400 to S411 of Fig. 
25 is carried out from S1400 to S1411 of Fig. 45, and then 
the processing from SIOOO to S1018 of Fig. 46, which is a 
subroutine of S1412, is carried out. 

To be specific, first, in SIOOO, the value of the 
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reference body yaw angle at the current time is 
substituted into the desired body yaw angle. Further, the 
value of a reference arm posture at the current time is 
substituted into the desired arm posture^ excluding the 
5 arm posture antiphase arm swing angle and the angular 
velocity. 

Then, the processing proceeds to S1002 wherein it is 
determined whether the current time is in the period of 
restoring a body posture angle and an antiphase arm swing 
10 angle (the period from time Ta to time Tb) . The 

processing proceeds to S1004 if the determination result 
of S1002 is NO, or to S1006 if the determination result is 
YES. 

In S1004, the same processing as that for calculating 
15 the horizontal body acceleration a, the body angular 
acceleration p, and the antiphase arm swing angular 
acceleration pa (from S504 to S528 of Fig. 26) in a period 
other than the body inclination angle/ antiphase arm swing 
angle restoring period is carried out. 
20 In the case where the processing proceeds to S1006, 

the horizontal body acceleration atmp, which is required 
to satisfy the current time (time k) desired ZMP if a 
motion of the body translational mode is to be performed, 
is determined in S1006. 
25 Then, the processing proceeds to S1008 wherein the 

instantaneous value ZMPrec of a body inclination restoring 
moment ZMP-converted value pattern at the current time is 
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calculated on the basis of the parameters related to the 
body inclination restoring moment ZMP- converted value 
pattern determined in S718. 

The processing then proceeds to SlOlO wherein an 
instantaneous value Parec of the antiphase arm swing 
restoring angular acceleration pattern at the current time 
is calculated on the basis of the parameters related to 
the antiphase arm swing restoring angular acceleration 
pattern determined in S722. 

Subsequently, the processing proceeds to S1012 
wherein the body angular acceleration (body inclination 
angular acceleration) p of the body inclination mode is 
determined according to the equation shown in the figure. 

Subsequently, the processing proceeds to S1014 
wherein the horizontal body acceleration a is determined 
according to the equation shown in the figure. 

Subsequently, the processing proceeds to S1016 
wherein the sum of the instantaneous value parec of an 
antiphase arm swing restoring angular acceleration pattern 
calculated in SlOlO and a reference antiphase arm swing 
angular acceleration Paref (a value obtained by subjecting 
a reference antiphase arm swing angle to second order 
differentiation) is substituted into a desired antiphase 
arm swing angular acceleration Pa. 

Subsequently, the processing proceeds to S1018 
wherein a floor reaction force horizontal component Fx 
when the horizontal body acceleration is a is determined. 
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Subsequently, the processing proceeds to S1414 
wherein the horizontal body acceleration and the body 
posture angular acceleration are Integrated to calculate a 
horizontal body velocity and a body posture angular 
5 velocity (body Inclination angular velocity) . The 

calculated result Is further integrated to determine a 
horizontal body position and a body posture (the body 
inclination angle). A body yaw angle in the body posture 
is determined by a reference body yaw angle in the present 
10 first reference example. 

Subsequently, the processing proceeds to S1416 
wherein the antiphase arm swing acceleration is Integrated 
to calculate an antiphase arm swing angular velocity. The 
calculation result is further integrated to determine an 
15 antiphase arm swing angle. 

Thus, the processing of S030 of Fig. 13 is completed. 

Subsequently, the processing proceeds to S032 wherein 
time t for generating a gait is incremented by At, and 
returns to S014 to continue to generate gaits as described 
20 above. 

The above is the processing for generating desired 
gaits in the gait generating device 100. 

The operation of the device according to the present 
first reference example will be further explained with 
25 reference to Fig. 4. In the gait generating device 100, a 
desired gait is generated as described above. In the 
generated desired gait, a desired body position/posture 
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(trajectory) and a desired arm posture (trajectory) are 
sent out to a robot geometric model (an Inverse kinematics 
calculator) 102 • 

A desired foot position/posture (trajectory), a 
desired ZMP trajectory (desired total floor reaction force 
central point trajectory) , and a desired total floor 
reaction force (trajectory) (a desired floor reaction 
force horizontal component and a desired floor reaction 
force vertical component) are sent to a composite- 
compliance operation determiner 104 and also to a desired 
floor reaction force distributor 106. In the desired 
floor reaction force distributor 106, the floor reaction 
force is distributed to the feet 22R and 22L, and a 
desired floor reaction force central point of each foot 
and a desired floor reaction force of each foot are 
determined. The determined desired floor reaction force 
central point of each foot and the desired floor reaction 
force of each foot are sent to the composite-compliance 
operation determiner 104. 

A corrected desired foot position/posture 
(trajectory) with deformation compensation is sent from 
the composite-compliance operation determiner 104 to the 
robot geometric model 102. Upon receipt of the desired 
body position/posture (trajectory) and the corrected 
desired foot position/posture (trajectory) with 
deformation compensation, the robot geometric model 102 
calculates joint displacement commands (values) of twelve 
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joints (lOR(L), etc.) of the legs 2, 2 that satisfy them 
and sends the calculated commands to a displacement 
controller 108. The displacement controller 108 performs 
follow-up control on the displacements of the twelve 
Joints of the robot 1, using the joint displacement 
commands (values) calculated by the robot geometric model 
102 as desired values. In addition, the robot geometric 
model 102 calculates arm joint displacement commands 
(values) that satisfy the desired arm postures and sends 
the calculated commands (values) to the displacement 
controller 108. The displacement controller 108 performs 
follow-up control on the displacements of the twelve 
joints of the arms of the robot 1, using the joint 
displacement commands (values) calculated by the robot 
geometric model 102 as desired values. 

A floor reaction force generated in the robot 1 (more 
specifically, an actual floor reaction force of each foot) 
is detected by a six-axis force sensor 50. The detected 
value is sent to the composite -compliance operation 
determiner 104. 

In the actual body posture angular error (the 
difference between the desired body posture and an actual 
body posture (the actual posture of the body 3)) occurring 
in the robot 1, posture inclination angle errors 9errx and 
Berry (specifically, the error of the inclination angle of 
an actual body posture relative to the vertical direction 
with respect to the inclination angle of a desired body 
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posture relative to the vertical direction, a posture 
Inclination angle error In the roll direction (about the 
X-axls) being Serrx, and a posture Inclination angle error 
In the pitch direction (about the Y-eacls) being Berry) Is 
detected via a posture sensor 54, and the detected value 
Is sent to a posture Inclination stabilization control 
calculator 112. The posture Inclination stabilization 
control calculator 112 calculates the horizontal component 
of a compensating total floor reaction force moment about 
a desired total floor reaction force central point 
(desired ZMP) for restoring the actual body inclination 
angle of the robot 1 to the desired body posture angle, 
and sends it to the composite-compliance operation 
determiner 104. 

More specifically, in the present first reference 
example, a compensating total floor reaction force moment 
horizontal component Mdmdxy is determined according to the 
following equation by using, for example, PD control law: 

Compensation total floor reaction force moment horizontal 

component Mdmdxy 

= KSb * Body posture inclination angle error 
+ Kcob * Body posture inclination angular velocity error 

d25 

where KSb and Kcob are predetermined gains. The body 
posture inclination angular velocity error is a temporal 
differential value of the body posture inclination angle 
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error, and means an error of an actual body posture 
Inclination angular velocity with respect to a desired 
body posture Inclination angular velocity. The body 
posture Inclination angle error Is, more specifically, a 
vector composed of a posture Inclination angle error of 
the body 3 of the robot 1 In the roll direction (about the 
X-axls) and a posture Inclination angle error thereof In 
the pitch direction (about the Y-axls). 

Furthermore, a yaw angle error Berrz In the above 
actual body posture angle error occurring In the robot 1 
(more specifically, the posture angle error In the yaw 
direction (about the Z-axls) In the actual body posture 
angle error Is Serrz) Is detected through the Intermediary 
of the posture sensor 54, and the detected value Is sent 
to a yaw stabilization control calculator 113. The yaw 
stabilization control calculator 113 calculates the 
vertical component of the compensating total floor 
reaction force moment about a desired total floor reaction 
force central point (desired ZMP) for converging an actual 
body yaw angle and/or an angular velocity of the robot 1 
to a desired body yaw angle and/or an angular velocity, 
and sends It to the composite-compliance operation 
determiner 104. The composite-compliance operation 
determiner 104 corrects the desired floor reaction force 
on the basis of the Input value. Specifically, the 
desired floor reaction force Is corrected such that the 
compensating total floor reaction force moment acts about 
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the desired total floor reaction force central point 
(desired ZMP) . 

More specifically. In the present first reference 
example, a compensating total floor reaction force moment 
vertical component Mdmdz Is determined according to the 
following equation by using, for example, the PD control 
law: 

Compensation total floor reaction force moment vertical 
component Mdmdz = K6bz * Body yaw angle error 
+ Kcobz * Body yaw angular velocity error 

d26 

where K6bz and Kcobz are predetermined gains. The 
body yaw angular velocity error is a temporal differential 
value of the body yaw angle error, and means an error of 
an actual body yaw angular velocity relative to a desired 
body yaw angular velocity. 

Supplementally, when the compensating total floor 
reaction force moment vertical component Mdmdz is 
determined according to the Equation d26 given above, K6bz 
is set to zero if the purpose is merely to prevent a 
rotational slippage about the vertical axis between the 
feet 22 and a floor or rotational vibration about a 
vertical axis. This is because an attempt to approximate 
also the body yaw angle error to zero tends to cause an 
Increase in an actual floor reaction force moment vertical 
component . 
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The composite -compliance operation determiner 104 
corrects the desired floor reaction force on the basis of 
the Input value. Specifically, the desired floor reaction 
force moment horizontal component Is corrected such that 
the compensating total floor reaction force moment 
horizontal component acts about the desired total floor 
reaction force central point (desired ZMP) . In addition, 
the desired floor reaction force moment vertical component 
Is corrected by additionally adding the compensating total 
floor reaction force moment vertical component to the 
desired floor reaction force vertical component about the 
desired total floor reaction force central point (desired 
ZMP) that dynamically balances with the desired gait. 

The composite -compliance operation determiner 104 
determines the aforesaid corrected desired foot 
position/posture (trajectory) with deformation 
compensation such that the state of the actual robot 1 and 
the floor reaction force calculated from sensor detection 
values or the like agree with the corrected desired floor 
reaction force. It Is actually Impossible, however, to 
make every state agree with a desired state, so that a 
trade-off relationship Is established therebetween to make 
them compromlslngly agree with each other as much as 
possible. More specifically, control errors with respect 
to desired values are weighted, and control Is carried out 
to minimize the weighting average of control errors (or 
squares of control errors ) . With this arrangement , the 
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control Is conducted such that actual foot 
position/posture and a total floor reaction force almost 
follow desired foot position/posture and a desired total 
floor reaction force. 
5 The main point of the present invention is the 

generation of gaits of the robot 1 by the gait generating 
device 100, and the construction and operation of the 
composite -compliance operation determiner 104 or the like 
described above are disclosed in detail primarily in 

10 Japanese Unexamined Patent Application Publication No. 11- 
300661 previously applied by the present applicant; 
therefore, no more explanation will be given. 

In S028, as previously discussed, the current time 
gait parameters are corrected such that a terminal 

15 divergent component of the current time gait agrees with 
q" , which is a value obtained by observing an initial 
divergent component q [0] of a normal turning gait from 
the current time's gait supporting leg coordinate system. 
Actually, the divergent component is an indicator for 

20 assessing whether the horizontal body position of a 

generated gait converges to a normal turning gait when the 
gait is generated on the basis of current time gait 
parameters by using a dynamic model and the gait is 
repeatedly generated in succession on the basis of normal 

25 turning gait parameters. Basically, the divergent 

component must be defined so that a terminal divergent 
component of the current time gait agrees with q" , which 
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Is a value obtained by observing a normal turning initial 
divergent component q [0] from the current time's gait 
supporting leg coordinate system, at convergence. 

The divergent component defined by Equation 10 is 
5 actually a divergent component that approximately 
satisfies the aforesaid properties. 

Hence, in the present first reference example, it may 
be said that the current time gait parameters have been 
corrected so that the horizontal body position of a 

10 generated gait converges (approximates) to the horizontal 
body position of a normal turning gait when the gait is 
generated on the basis of current time gait pareuneters by 
using a dyneunic model and the gait is repeatedly generated 
in succession on the basis of normal turning gait 

15 parameters. Technically, however, only the first turning 
gait immediately following the current time gait must be 
the gait that has been corrected on the basis of the 
trapezoidal heights bl and bzl of the first turning gait 
determined as described above. In other words, if the 

20 gait that combines the current time gait and the first 

turning gait is regarded as the current time gait, then, 
in the present reference example, it may be said that the 
current time gait parameters have been corrected so that 
the body posture angle of a generated gait converges 

25 (approximates) to the body posture angle of a normal gait 
composed of a second turning gait and the first turning 
gait when the gait is repeatedly generated, as described 
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above • 

This Is the same as that disclosed in PCT publication 
of unexamined application WO/02/40224. 

Especially in the present first reference example, 
5 the desired ZMP pattern of the gait pareuneters of the 

current time gait has been corrected so as to satisfy the 
condition (the current time gait approximating the normal 
gait). This will be explained with reference to Fig. 47. 
The trajectory indicated by reference mark B in the figure 

10 shows the horizontal body position trajectory generated so 
that divergent components agree at a gait boundary, as 
described above. 

The trajectory indicated by reference mark A in the 
figure shows the horizontal body position trajectory 

15 obtained when a current time gait is generated so that 
horizontal body positions /velocities at boundaries of 
normal turning gaits agree, and then a normal gait is 
repeatedly generated. 

As shown in the figure, the trajectory indicated by 

20 reference mark B generally deviates from the trajectory 
indicated by reference mark A at the boundary of the 
current time gait and a first normal turning gait. 
Thereafter, however, the trajectory indicated by reference 
mark B gradually converges to (approximates) the 

25 trajectory indicated by reference mark A and substantially 
agrees with the trajectory indicated by reference mark A 
in the next normal turning gait period. Thus, the gait 
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generating technique for making only the divergent 
components agree at a gait boundary also permits the 
prevention of gait divergence, as the gait generating 
technique for making both position and velocity agree at a 
gait boundary. The example indicated by reference mark C 
in the figure shows an example wherein a trajectory has 
been generated without considering them. In such a case, 
the generated trajectory diverges as time elapses. It is 
of course possible to complicate a desired ZMP pattern and 
a plurality of parameters is adjusted to make both 
position and velocity agree; this, however, may cause a 
desired ZMP pattern to stagger. Incidentally, if both 
position and velocity are made to agree, then divergent 
components also agree, so that the method for making both 
position and velocity agree may be said to be a special 
example of the method for making divergent components 
agree . 

Furthermore, in the present first reference example, 
it may be said that the current time gait parameters have 
been corrected so that the body posture angle of a 
generated gait converges (approximates) to or agrees with 
the body posture angle of a normal turning gait when the 
gait is generated on the basis of current time gait 
parameters by using a dynamic model and the gait is 
repeatedly generated in succession on the basis of normal 
turning gait parameters. Technically, however, only the 
first turning gait immediately following the current time 



gait must be a gait that has been corrected by the 
trapezoidal heights bl and bzl of the first turning gait 
determined as described above. 

A few modifications of the present first reference 
example will be explained below. The modifications 
explained below apply to the embodiments, which will be 
discussed hereinafter. 

In the present first reference example, for easier 
understanding, it has been arranged so that the floor 
reaction force horizontal component permissible range can 
be independently set for the longitudinal direction (X- 
axls direction) component and the lateral direction (Y- 
axls direction) component. More slippage-resistant gaits 
are generated by representing it by a relational 
expression of the longitudinal direction and the lateral 
direction. 

For instance, a so-called friction circle shown by 
the following equation may be used as a permissible range. 

(X component of floor reaction force horizontal component) 
* (X component of floor reaction force horizontal 
component) + (Y component of floor reaction force 
horizontal component) * (Y component of floor reaction 
force horizontal component) {Ksl * \i * Fz) * {l^a ^ \i Fz) 

... Equation 59 
where Fz denotes a desired floor reaction force 
vertical component, fji denotes a frictional coefficient. 
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and ka denotes a positive constant of 1 or less. 

However, If the floor reaction force horizontal 
component permissible range Is represented by the 
relational expression of the longitudinal direction and 
the lateral direction, as described above, then It Is 
necessary to simultaneously or alternately determine a 
motion on a sagittal plane and a motion on a lateral plane 
so as to simultaneously or alternately satisfy the 
permissible range. 

A permissible range composed of a combination of a 
floor reaction force horizontal component and a floor 
reaction force moment vertical component may be set 
instead of setting the floor reaction force horizontal 
component permissible range and the floor reaction force 
moment vertical component permissible range separately, as 
described above. As the floor reaction force horizontal 
component Increases, the friction limit of a floor 
reaction force moment vertical component diminishes . 
Further, as the floor reaction force moment vertical 
component Increases, the friction limit of the floor 
reaction force horizontal component diminishes. Taking 
this into account, therefore, setting a permissible range 
composed of the combination of a floor reaction force 
horizontal component and a floor reaction force moment 
vertical component makes it possible to set a permissible 
range that is closer to an actual friction limit 
characteristic. Specifically, a permissible range may be 
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set for a weighted average of an absolute value of a floor 
reaction force horizontal component and an absolute value 
of a floor reaction force moment vertical component. 

In the present first reference example, two motion 
5 modes, namely, the body Inclination mode and the body 

translatlonal mode, have been used to obtain proper values 
for the floor reaction force horizontal component and the 
floor reaction force moment horizontal component about a 
desire ZMP; however, motion modes other than these may be 
10 used. 

For example, as shown In Fig. 48, when the body 
posture Is turned with the hip joints being as the turning 
center, the angular momentum about the total center of 
gravity changes and the total center of gravity also 

15 changes accordingly. Overlapping (combining) this motion 
and the above-mentioned body translatlonal mode at a 
predetermined ratio produces almost the same motion as 
that of the body Inclination mode, and the floor reaction 
force horizontal component Is no longer produced. Hence, 

20 If this Is regarded again as the body Inclination mode, 
then a similar gait can be generated according to the 
algorithm of the present first reference example. 

Thus, It Is not required that one of the motion modes 
Is a motion mode that does not produce a floor reaction 

25 force horizontal component. This Is because any floor 

reaction force horizontal component and a floor reaction 
force moment about a desired ZMP can be generated as In 
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the aforesaid example by any combination of modes as long 
as two motion modes having different generation ratios of 
a floor reaction force horizontal component and a floor 
reaction force moment about a desired ZMP are used. 

A motion mode other than the motion mode that changes 
a body posture may be used. It Is preferable, however, to 
select a motion mode that allows a largest possible floor 
reaction force horizontal component or a largest possible 
floor reaction force moment about a desired ZMP to be 
generated In response to a minimized displacement. 

For example, a motion mode for swinging the distal 
positions of right and left arms In the same direction, or 
a motion mode for perturbatlng the position of a foot not 
In contact with the ground (existing in the air) may be 
selected. However, when perturbatlng a free leg 
trajectory, the amount of perturbation should be returned 
to virtually zero by the time immediately before landing, 
so that a landing position will not change. It is of 
course possible to combine the motion mode for swinging 
the distal positions of right and left arms in the same 
direction and an antiphase arm swing mode. 

Further alternatively, three or more motion modes may 
be used. 

At least two of selected motion modes have mutually 
different ratios of a floor reaction force horizontal 
component to a floor reaction force moment about a desired 
ZMP generated by the motion modes. Otherwise, there will 
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be usually no solution of a simultaneous equation (the 
behavior of each motion mode cannot be uniquely 
determined) . 

In addition. It Is preferred to combine, as much as 
5 possible, a motion mode that allows a sufficiently large 
change to take place In a floor reaction force moment 
about a desired ZMP while minimizing a change In a floor 
reaction force horizontal component, and a motion mode 
that allows a sufficiently large change to take place In a 
10 floor reaction horizontal component while minimizing a 
change In a floor reaction force moment about a desired 
ZMP. 

In other words. It Is desirable to combine a motion 
mode that allows a sufficiently large change to take place 

15 In an angular momentum while minimizing a change in a 

total center of gravity, and a motion mode that allows a 
sufficiently large change to take place in a total center 
of gravity while minimizing a change in an angular 
momentum. This is because a displacement of a motion mode 

20 will be smaller. 

Further, a body yaw rotation mode may be used in 
place of the antiphase arm swing mode to prevent a floor 
reaction force moment vertical component from exceeding a 
permissible range (to cancel a spinning force). When the 

25 body yaw rotation mode is used, it is preferred to divide 
the body 3 of the robot 1 into a part close to the waist 
(e.g., the part below a member 54 shown in Fig. 1) and the 
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part above it (e.g., the part above the member 54 shown in 
Fig. 1) such that the upper part may turn in the yaw 
direction (e.g., about a trunk axis of the body 3) 
relative to the part close to the waist. This makes it 
5 possible to allow the upper part of the body 3 to rotate 
so as to permit adjustment of a floor reaction force 
moment vertical component without affecting the postures 
of the legs 2 and 2. As a reference example in such a 
case, the rotational angle of the upper part of the body 3, 

10 and the angular velocity and the angular acceleration 
thereof may be determined instead of determining the 
antiphase arm swing angle and the angular velocity and the 
angular acceleration in, for instance, the aforementioned 
first reference example. In this case, the relative 

15 positions of the two arms 5 and 5 with respect to, for 
example, the upper part of the body 3 may be fixed. An 
antiphase arm swing operation of the two arms 5 and 5 may 
be of course added to the yaw rotation of the upper part 
of the body 3 . 

20 Alternatively, a motion mode may be used that 

displaces a part other than the arms and the body as long 
as it generates a floor reaction force moment vertical 
component . 

For example, a motion mode may be used that moves the 
25 distal ends of both legs in opposite longitudinal 
directions in a floating period. 

Alternatively, a few motion modes generating a floor 
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reaction force moment vertical component may be used 
together. For example, the antiphase arm swing mode and 
the body yaw rotation mode may be used In combination. 
The body yaw rotation mode and the antiphase arm 
5 swing mode are the modes that generate a floor reaction 
force moment vertical component In such a manner that a 
total center-of -gravity position remains unchanged (In 
other words , without generating a floor reaction force 
horizontal component). However, motions causing a total 

10 center-of -gravity position to change (In other words, 
motions that generate floor reaction force horizontal 
components) may alternatively be also used. This Is 
because the floor reaction force horizontal component can 
be adjusted by combining these modes with the body 

15 translatlonal mode. 

In addition to the dynamic model used In the 
aforesaid first reference example (the dynamic model shown 
In Fig. 12), the following models may be used. 

1) Non-linear model having mass points set at a plurality 
20 of links, as shown in Fig. 49 (multi-mass-point model). 

Inertia (inertial moment) may be set at each link of the 
model . 

2) Three -mass -point model disclosed in PCT Kokai 
publication WO/02/40224 by the present applicant. 

25 3) Model that Ignores the moment of an inertial force 

generated by the body yaw rotation mode or the antiphase 
arm swing mode. 
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4) Separate type model that separately has a partial model 
representing a relationship between a resultant force of 
gravity and an inertial force (or a floor reaction force 
balancing therewith) and a body translational motion, and 
a partial model representing a relationship between the 
above resultant force and a body posture rotational motion 
(a body inclination motion and a body yaw rotational 
motion). For instance, the mass points shown in Fig. 12 
constitute partial models representing the relationship 
between the above resultant force and the body 
translational motion, and the flywheels shown in Fig. 12 
constitute partial models representing the relationship 
between the above resultant force and a body posture 
rotational motion. 

Any one of 1) through 4) shown above requires a 
motion mode that generates a moment vertical component of 
an inertial force - 

The same model may be used for each processing or 
models may be properly used according to processing. For 
example, the aforementioned normal gait is generated 
merely to determine a terminal state of the current time 
gait, so that the dyneimic accuracy required of the normal 
gait is lower than that required of the current time gait. 
Hence, for example, the processing for generating the 
current time gait may use the dynamic model shown in Fig. 
12 (the model with 3 mass points + flywheels), while the 
processing for generating a normal gait (particularly S408 
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and S412 of Fig. 21) may generate a normal gait by using a 
dynamic model composed of a body mass point 3m 
corresponding to the body 3 and flywheels FHx, FHy, FHaz , 
and FHbz (the model of one mass point + flywheels, which 
corresponds to the model of Fig. 12 from which leg mass 
points 2m and 2m have been removed) , ignoring the mass of 
each leg 2. The processing for generating the normal gait 
in this case may carry out the processing of S408 and S412 
of Fig. 25 with the mass of the leg mass point being set 
to zero in the aforesaid reference example. This makes it 
possible to dramatically reduce the calculation volume in 
the processing of generating normal gaits. 

In the aforesaid first reference example, the block 
charts, the flowcharts, and algorithms or the like may be 
subject to equivalent modifications, including modified 
calculation processing sequences. Furthermore, a low-pass 
filter may be inserted, as necessary. 

Although the aforesaid first reference example has 
been explained in conjunction with the bipedal mobile 
robot; however, it may be applied also to multi-legged 
robots having three or more feet. 

Instead of using the techniques for determining the 
initial state of a normal gait (primarily an initial 
horizontal body position/velocity, and initial vertical 
body position/velocity and antiphase arm swing angle and 
angular velocity) by using exploratory techniques or 
partially using analyzing techniques, as in the aforesaid 
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first reference example, diverse normal gait parameters 
may be calculated using the above techniques beforehand 
and the relationship between the normal gait parameters 
and the Initial states of normal gaits may be mapped or 
5 processed Into an approximate expression and stored so as 
to determine the Initial values of the normal gait on the 
basis of the relationship, which has been mapped or formed 
into approximate expressions, at the time of actual travel. 
Further alternatively, a function that combines the 

10 aforesaid relationship, which has been mapped or processed 
into an approximate expression, and the aforesaid function 
f may be mapped or processed into an approximate 
expression and stored. More specifically, from the normal 
gait parameters composed of the aforesaid foot trajectory 

15 parameters, the floor reaction force vertical trajectory 
parameters, etc., the functions for directly determining 
the divergent components of normal gaits may be mapped or 
processed into approximate expressions and the results may 
be stored. For example, a normal gait may be generated in 

20 advance for each set of a plurality of types of typical 
normal gait parameters, the initial state of the normal 
gait for each set of normal gait parameters (to be 
determined in S024 of Fig. 13) may be determined 
beforehand, and a map that shows the relationship between 

25 the normal gait parameters of each set and the normal gait 
initial states may be prepared in advance. Then, when 
generating a desired gait, the initial state of a normal 
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gait may be determined by selecting or Interpolating from 
among the sets of the determined normal gait parameters on 
the basis of the aforesaid map. This arrangement obviates 
the need for generating a normal gait each time a current 
5 time gait Is generated, thus permitting a significant 

reduction In the amount of calculation for the processing 
of generating a desired gait. 

As the method for correcting a current time gait to 
connect (approximate) It to a normal gait, the desired ZMP 

10 parameter of the current time gait has been corrected in 
the present first reference example. However, other 
parameters may alternatively be corrected. 

For Instance, the trajectory of a free leg In the air 
In a current time gait may be changed. If, for example, a 

15 horizontal body position Is likely to shift farther to the 
rear than a normal gait, then a free leg Is promptly moved 
forward after It leaves a floor so as to shift the 
position of the center of gravity of the free leg toward 
the front. This causes the horizontal body position for 

20 satisfying a desired ZMP to be unavoidably further 

accelerated toward the front. As a result, the horizontal 
body position moves further forward at the end of the 
current time gait, making It possible to match the normal 
gait. 

25 Instead of correcting a desired ZMP parameter, the 

cycle of a current time gait may be corrected. For 
Instance, if the horizontal body position is likely to 
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Shift farther to the rear than a normal gait, then the 
cycle of the current time gait may be extended. Extending 
the cycle of the current time gait will extend the time 
for the horizontal body position to move, permitting extra 
5 forward movement to be accomplished accordingly. 

However, If a desired ZMP parameter Is corrected when 
determining an appropriate value of the horizontal body 
position or the like by an exploratory technique, the 
horizontal body position at the end of the current time 

10 gait changes substantially proportionally to a correction 
amount of the desired ZMP, so that the number of 
explorations of the appropriate value can be reduced. In 
comparison to this, correcting the center-of -gravity 
trajectory of a free leg or the cycle of a gait requires a 

15 greater number of explorations for the appropriate value, 
because the horizontal body position at the end of the 
current time gait changes considerably nonllnearly in 
response to the correction. 

In the present first reference example, the desired 

20 ZMP parameter of the current time gait has been corrected, 
as the method for correcting the current time gait to 
connect (approximate) it to the normal gait. This method 
may lead to an excessive correction amount (correction 
amount a shown in Fig. 34) of the desired ZMP parameter in 

25 some cases. For instance, if a request for an abrupt 

changeover from the gait of hopping at a spot to a high- 
speed travel (a request for running) is Issued, then the 
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desired ZMP parameter must be given an extremely large 
shift backward relative to an advancing direction In order 
to ensure connection (approximation) to a high- speed 
normal gait (normal gait for running) . In this case, as 
5 discussed above, gait parameters in addition to the 

desired ZMP parameter are preferably corrected. In this 
case, however, the request for such an abrupt acceleration 
Itself is actually unreasonable, so that a required value 
Itself may be corrected as an alternative. 

10 To correct the required value, for example, a normal 

gait satisfying the request (the required parameter) is 
determined, for the time being, according to the procedure 
shown in the present first reference example, and at the 
point when a current time gait parameter has been 

15 determined so that it connects to the normal gait, it is 
determined whether the stability margin for the desired 
ZMP trajectory of the current time gait has been unduly 
reduced. If the stability margin has reduced too much (if 
the desired ZMP has deviated from a so-called supporting 

20 polygon or the desired ZMP is positioned near an edge of 

the supporting polygon), then the request may be corrected. 

Alternatively, the permissible range of 
acceleration/deceleration of a gait (Next time gait 
initial velocity - Current time gait initial velocity) / 

25 Cycle of current time gait) is set beforehand, and at the 
point when a request (a required parameter related to a 
gait cycle) is received, the acceleration/deceleration 
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based on the request Is determined, and If the determined 
acceleration/deceleration exceeds the permissible range, 
then the request may be corrected so that it falls within 
the permissible range. 
5 Supplementally, if simple dynamic models as discussed 

above are used, the aforesaid AMp, AFp, AMr, AFr, AMaz, 
and AMbz may be analytically determined by dynamic 
calculation; however, if a general, more complicated 
dynamic model is used, then they may be determined as 

10 follows. A floor reaction force in a case where the body 
3 is accelerated by an extremely small cunount by the body 
translational mode or accelerated by an extremely small 
amount by the body inclination mode is determined, and 
then the difference between this determined floor reaction 

15 force and the floor reaction force obtained in a case 

where the body 3 is not accelerated is determined. Then, 
the difference is divided by the above extremely small 
amount . 

Alternatively, the average value of each of AMp, AFp, 
20 AMr, AFr, AMaz, AMbz, and AMp/AMr or the like in standard 
gaits may be determined in advance and may be used. AMp, 
AFp, AMr, AFr, AMaz, AMbz, and AMp/AMr vary according to a 
state (a posture and its changing rate), so that the 
accuracy slightly deteriorates, as compared with a method 
25 in which they are determined for each state at each 
instant; however, the amount of calculation can be 
significantly reduced when models that are more 
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complicated than the aforesaid models are used. 

The following method may be used as the method for 
determining the height bzcurr of the trapezoid of the 
antiphase arm swing restoring angular acceleration pattern 
5 of the current time gait. 

The antiphase arm swing angle and the angular 
velocity at the end of the current time gait of the 
aforesaid gait with a corrected antiphase arm swing 
restoring angular acceleration (refer to the explanation 

10 of S722 of Fig. 42) are denoted by Szcurr and v6zcurr^ 
respectively, and the differences between these and the 
antiphase arm swing angle and the angular velocity of a 
normal gait are denoted by ASzcerr and AvSzcerr. 

A discrete type state equation may be set up, in 

15 which a gait cycle is defined as an interval, the 
differences Szerr and v6zerr between the terminal 
antiphase arm swing angle and angular velocity of a 
provisional current time gait and the initial antiphase 
arm swing angle and angular velocity of a normal gait 

20 denote a last time state, bzcurr denotes an input, and 
ABzcerr and AvOzcerr denote a current state, and then a 
feedback rule may be determined using a modern control 
theory or the like so as to converge AOzcerr and AvOzcerr 
to zero. The determined feedback rule may be used to 

25 obtain bzcurr. 

Based mainly on the difference between desired 
antiphase arm swing angle/angular velocity and reference 
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antiphase arm swing angle/angular velocity at each Instant, 
the value of the antiphase arm swing restoring angular 
acceleration parec at each Instant may be determined by 
using a state feedback rule or the like so as to converge 
5 the above difference to zero rather than using a 

trapezoidal pattern to determine the antiphase arm swing 
restoring angular acceleration parec of a current time 
gait and/or a normal gait. 

Based on desired antiphase arm swing angle/angular 

10 velocity of a current time gait at each Instant, the 

antiphase arm swing restoring angular acceleration parec 
at each Instant may be determined by using a state 
feedback rule or the like such that these will approximate 
initial antiphase arm swing angle/angular velocity of a 

15 first turning gait rather than using a trapezoidal pattern 
to determine the antiphase arm swing restoring angular 
acceleration parec of a current time gait. 

To generate a gait for traveling on a slope (when 
moving the robot 1 on a slant floor surface) , the 

20 permissible range of the floor surface horizontal 

component of a translatlonal floor reaction force (a 
component parallel to the floor surface), that is, the 
permissible range of fictional force, or the permissible 
range of the floor surface horizontal component of a total 

25 center -of -gravity acceleration (this is proportionate to a 
frlctional force) may be set in place of a floor reaction 
force horizontal component permissible range or a total 
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center- of- gravity acceleration horizontal component 
permissible range. A case, for example, where the 
permissible range of the floor surface horizontal 
component (frictional force) of a translational floor 
5 reaction force will be explained (this explanation applies 
also to a case where the permissible range of a floor 
surface horizontal component of total center-of -gravity 
acceleration is set ) . The frictional force is determined 
according to Equation 72 shown below if an inclination 

10 angle relative to the horizontal plane of a floor surface 
is defined as 6f (a slope down forward in the direction in 
which the robot 1 advances is defined as a positive slope) . 
Therefore, to generate a gait according to the same 
algorithm as that in the aforesaid first reference example, 

15 the Equation 72 may be used to convert a frictional force 
permissible range into a floor reaction force horizontal 
component permissible range thereby to set the floor 
reaction force horizontal component permissible range. In 
this case, a desired floor reaction force vertical 

20 component may be used as the floor reaction force vertical 
component of Equation 72. 



Frictional force = Floor reaction force horizontal 
component * cos(6f ) - Floor reaction force vertical 
25 component * sin(ef ) ... Equation 72 



When generating a gait for traveling on a slope (when 
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moving the robot 1 on an Inclined floor surface ) , a floor 
reaction force moment vertical component can be converted 
Into a moment In the direction of the normal line of a 
floor surface frlctlonal force according to Equation 1072, 
5 so that the permissible range of the component In a floor 

surface normal line of a floor reaction force moment. I.e., 
the permissible range of the moment In the direction of 
the normal line of a floor surface frlctlonal force, may- 
be set In place of the permissible range of a floor 
10 reaction force moment vertical component. 

Moment In the direction of the normal line of floor 
surface frlctlonal force = Vertical component of floor 
reaction force moment * cos (Of) Equation 1072 

15 

The parameters of a current time gait may be re- 
determined In the middle of the generation of a current 
gait, as disclosed In PCT Kokai publication WO/02/40224 by 
the present applicant. Instead of determining them when a 

20 last time gait is completed, as in the aforesaid first 

reference example. This allows an immediate response to 
be taken if a gait request changes, although it involves 
an Increased calculation volxime. 

If correction of a gait (re -determination of a 

25 current time gait parameter) is not completed within a 
current control cycle, then an uncorrected gait or 
provisionally corrected gait (a gait in the middle of 
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exploration. I.e., a gait that does not fully satisfy an 
exploration completion condition (a deviation of a gait 
boundary condition being less than a permissible value)). 
Is tentatively output, and a properly corrected (non- 
5 provisional) gait may be output by the next control cycle 
or by a plurality of control cycles later. The corrected 
desired ZMP trajectory and desired floor reaction force 
vertical component trajectory are connected, and these do 
not suddenly change In a short time; therefore, the 

10 desired ZMP trajectory and the desired floor reaction 

force vertical component trajectory of the current time 
gait will hardly present a problem although they will be 
slightly staggered. 

The aforesaid first reference example has explained 

15 the example of the case where the running gait shown in 
Fig. 5 Is generated; however, a desired gait can be 
generated In the same manner as that In the aforesaid 
first reference example when a walking gait of the robot 1 
Is generated. In this case, in the aforesaid first 

20 reference example, for Instance, a desired floor reaction 
force vertical component may be set according to the 
pattern shown in, for example. Fig. 50 in place of the one 
shown in Fig. 6 mentioned above. In this example, a floor 
reaction force vertical component trajectory is set to 

25 exhibit a trapezoidal shape projecting to an increasing 
side of the floor reaction force vertical component in a 
double stance period, and to exhibit a trapezoidal shape 
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projecting to a decreasing side of the floor reaction 
force vertical component In a single stance period. The 
details of the method for setting heights CI and C2 of the 
trapezoidal portions, and others are explained In detail 
5 In, for example, PCT Kokal publication WO/03/057425/A1 by 
the present applicant. Hence, the explanation will be 
omitted. 

On the basis of the first reference example and the 

10 modifications thereof explained above, a second reference 
example will now be explained with reference to Fig. 53 
through Fig. 58. In the explanation of the present second 
reference example, like constituent parts or like 
functional parts as those in the aforesaid first reference 

15 example will be assigned like reference numerals as those 
in the aforesaid first reference example, and the 
explanation thereof will be omitted. As previously 
mentioned, especially in the present second reference 
example, the aspects explained with reference to Fig. 1 to 

20 Fig. 3 and Fig. 5 to Fig. 12 are Identical to those in the 
aforesaid first reference example. 

An outline of the aspects of the present second 
reference example that are different from those of the 
aforesaid first reference exeunple will be explained. In 

25 the present second reference example, a desired gait is 
corrected in addition to manipulating a desired floor 
reaction force for compliance control in order to 
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approximate an actual body posture angle error, which Is 
the difference between a desired body posture angle and an 
actual body posture angle (an error of an Inclination 
angle relative to the vertical direction of the body 3 and 
5 an error of a yaw angle), and/or the changing rate thereof 
to zero. In particular, the vertical component of a floor 
reaction force moment about a desired ZMP that dynamically 
balances with a desired gait (the resultant force of the 
Inertlal force of a motion and gravity of a desired gait 

10 balances with the vertical component of a moment generated 
about the desired ZMP) Is also corrected on the basis of a 
yaw angle component and/or Its angular velocity out of an 
actual body posture error. 

A block diagram showing the functional construction 

15 of a control unit 60 In the present second reference 

example Is shown In Fig. 53. The following will explain 
the aspects of the functional construction of the control 
unit 60 In the present second reference example that are 
different from those of the aforesaid first reference 

20 example (those shown In Fig. 4). 

In the present second reference example, the 
compensating total floor reaction force moment horizontal 
component Mdmdxy calculated In a posture Inclination 
stabilization control calculator 112 Is supplied to a 

25 compensating total floor reaction force moment horizontal 
component distributor 110. The compensating total floor 
reaction force moment horizontal component distributor 110 
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divides the compensating total floor reaction force moment 
horizontal component Mdmdxy Into a desired floor reaction 
force moment horizontal component for compliance control 
and a model manipulation floor reaction force moment 
5 horizontal component. In other words, based on an actual 
body posture Inclination angle error, the desired floor 
reaction force moment horizontal component for compliance 
control and a model manipulation floor reaction force 
moment horizontal component are determined by the posture 

10 Inclination stabilization control calculator 112 and the 
compensating total floor reaction force moment horizontal 
component distributor 110. 

Specifically, In the compensating total floor 
reaction force moment horizontal component distributor 110, 

15 a model manipulation floor reaction force moment 

horizontal component Is determined first according to the 
equation given below. Incidentally, a permissible range 
of the floor reaction force moment horizontal component Is 
determined In the gait generating device 100, as will be 

20 discussed hereinafter. 

If Mdmdxy > Upper limit value of the permissible 
range of a floor reaction force moment horizontal 
component , then 

Model manipulation floor reaction force moment 

25 horizontal component = -Mdmdxy + Upper limit value of the 
permissible range of a floor reaction force moment 
horizontal component. 
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If Mdmdxy < Lower limit value of the permissible 
range of a floor reaction force moment horizontal 
component , then 

Model manipulation floor reaction force moment 
5 horizontal component = -Mdmdxy + Lower limit value of the 
permissible range of a floor reaction force moment 
horizontal component 

If the lower limit value of the permissible range of 
a floor reaction force moment horizontal component :s 
10 Mdmdxy, and Mdmdxy ^ the upper limit value of the 
permissible range of a floor reaction force moment 
horizontal component, then 

Model manipulation floor reaction force moment 
horizontal component » q 
15 Equation d27a 

Then, a desired floor reaction force moment 
horizontal component for compliance control Is determined 
according to the following equation. 

Desired floor reaction force moment horizontal 
20 component for compliance control 

= Mdmdxy + Model manipulation floor reaction force 
moment horizontal component 

Equation d27b 

Accordingly, the floor reaction force moment 
25 horizontal components are determined such that the 

difference between the desired floor reaction force moment 
horizontal component for compliance control and the model 
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manipulation floor reaction force moment horizontal 
component Is equal to Mdmdxy. 

A block diagram of the compensating total floor 
reaction force moment horizontal component distributor 110 
5 that performs the aforesaid calculations Is shown In Fig. 
54. 

The compensating total floor reaction force moment 
vertical component Mdmdz determined In the same manner as 
that In the afore -mentioned first reference example in the 

10 yaw stabilization control calculator 113 (refer to the 
aforesaid Equation d26) Is supplied to a model 
manipulation floor reaction force moment vertical 
component determiner 111. The model manipulation floor 
reaction force moment vertical component determiner 111 

15 determines a model manipulation floor reaction force 

moment vertical component on the basis of the compensating 
total floor reaction force moment vertical component Mdmdz . 
In other words, the compensating total floor reaction 
force moment vertical component Mdmdz and the model 

20 manipulation floor reaction force moment vertical 

component are determined by the yaw stabilization control 
calculator 113 and the model manipulation floor reaction 
force moment vertical component determiner 111 on the 
basis of a body yaw angle error out of an actual body 

25 posture angle error. 

Specifically, in the model manipulation floor 
reaction force moment vertical component determiner 111, a 
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model manipulation floor reaction force moment vertical 
component Is determined according to the equation given 
below. Incidentally, the permissible range of the floor 
reaction force moment vertical component compensation 
5 amount Is determined In the gait generating device 100, as 
will be discussed hereinafter. 

If Mdmdz > Upper limit value of the permissible range 
of a floor reaction force moment vertical component 
compensation amount, then 
10 Model manipulation floor reaction force moment 

vertical component = -Mdmdz + Upper limit value of the 
permissible range of a floor reaction force moment 
vertical component compensation eimount. 

If Mdmdz < Lower limit value of the permissible range 
15 of a floor reaction force moment vertical component 
compensation amount, then 

Model manipulation floor reaction force moment 
vertical component = -Mdmdz + Lower limit value of the 
permissible range of a floor reaction force moment 
20 vertical component compensation amount. 

If the lower limit value of the pezmlsslble range of 
a floor reaction force moment vertical component 
compensation amount ^ Mdmdz, and Mdmdz ^ the upper limit 
value of the permissible range of a floor reaction force 
25 moment vertical component compensation amount, then 
Model manipulation floor reaction force moment 
vertical component = 0 
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Equation d26b 

A block dlagreun of the model manipulation floor 
reaction force moment vertical component determiner 111 
that performs the aforesaid calculations Is shown In Fig. 
5 55. Thus, the model manipulation floor reaction force 
moment vertical component Is set to the portion of the 
compensating total floor reaction force moment vertical 
component Mdmdz that has deviated from the permissible 
range of the floor reaction force moment vertical 
10 component compensation amount, the sign of the portion 
being reversed. 

The desired floor reaction force moment horizontal 
component for compliance control and the compensating 
total floor reaction force moment vertical component Mdmdz 
15 are sent to the composite -compliance operation determiner 
104. 

The model manipulation floor reaction force moment 
horizontal component and vertical component are sent to 
the gait generating device 100. 

20 In place of the compensating total floor reaction 

force moment vertical component Mdmdz, the sum of the 
compensating total floor reaction force moment vertical 
component Mdmdz and the model manipulation floor reaction 
force moment vertical component may be sent as a desired 

25 value for compliance control to the composite-compliance 
operation determiner 104. 

The composite-compliance operation determiner 104 
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corrects the desired foot position/posture such that an 
actual floor reaction force approximates the desired total 
floor reaction force corrected by adding a desired floor 
reaction force moment horizontal component for compliance 
5 control and the compensating total floor reaction force 
moment vertical component Mdmdz to a desired total floor 
reaction force generated by the gait generating device 100, 
while making the motion of the robot 1 follow the motion 
of a desired gait generated by the gait generating device 
10 100, thereby determining a corrected desired foot 
position/posture (trajectory) with defosnnatlon 
compensation • 

In this case. It Is actually Impossible to make every 
state of foot position/posture of the robot 1 and floor 

15 reaction force agree with a desired state, so that a 

trade-off relationship Is provided between them to reach 
compromlslngly closest possible agreement, as In the 
aforesaid first reference example. 

Although It will be discussed In more detail 

20 hereinafter, the gait generating device 100 generates the 
motion of a desired gait (particularly a body 
position/posture trajectory) by using a dynamic model so 
that the floor reaction force moment horizontal component 
about the desired ZMP determined by the gait generating 

25 device 100 becomes a model manipulation floor reaction 

force moment horizontal component. Furthermore, the gait 
generating device 100 corrects the motion of the desired 
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gait (particularly an arm swing trajectory) such that a 
model manipulation floor reaction force moment vertical 
component Is additionally generated In the desired floor 
reaction force moment vertical component about the desired 
5 total floor reaction force central point (the desired ZMP) 
that dynamically balances with the desired gait 
(provisional desired gait) generated, assuming the model 
manipulation floor reaction force moment Is zero. 

The functional construction of the control unit 60 

10 other than the above Is Identical to that of the aforesaid 
first reference example. Supplementally, the desired gait 
generated In the aforesaid first reference example Is 
Identical to the desired gait generated when the model 
manipulation floor reaction force moment horizontal 

15 component and the model manipulation floor reaction force 
moment vertical component are steadily set to zero In the 
present second reference example. 

An operation (processing for generating a gait) of 
the gait generating device 100 in the second reference 

20 example will be explained in detail below In conjunction 
with Fig. 56 showing the main flowchart thereof. From 
S3010 to S3028, the same processing as that from SOlO to 
S028 shown in Fig. 13 of the aforesaid first reference 
example is carried out. 

25 Subsequently, the processing proceeds to S3030 

wherein the parameters defining the permissible ranges of 
the floor reaction force moment horizontal component about 
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a desired ZMP for compliance control and a floor reaction 
force moment vertical component compensation amount are 
determined. 

A value obtained by dividing a floor reaction force 
5 moment horizontal component by a floor reaction force 

vertical component represents the amount of deviation of a 
ZMP (the central point of a floor reaction force) from a 
desired ZMP. Alternatively, therefore, the permissible 
range of a floor reaction force moment horizontal 

10 component may be divided by a floor reaction force 
vertical component to set the parameter of the ZMP 
permissible range converted Into a floor reaction force 
central point (the permissible range of a floor reaction 
force central point ) . 

15 Supplementally, based on the parameters of the 

permissible range of a floor reaction force moment 
horizontal component for compliance control and the 
permissible range of a floor reaction force moment 
vertical component compensation amount that are determined 

20 In S3030, the Instantaneous values of the permissible 

ranges will be determined In a subroutine for determining 
a current time gait instantaneous value (the subroutine of 
S3032), which will be discussed hereinafter, and the 
determined instantaneous values are used for the aforesaid 

25 processing in the aforesaid compensating total floor 

reaction force moment horizontal component distributor 110 
and model manipulation floor reaction force moment 
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vertical component determiner 111. 

Regarding the floor reaction force moment horizontal 
component permissible range, a method for setting a floor 
reaction force moment permissible range Is described In 
detail In PCT application PCT/ JP03/00435 by the present 
applicant. Hence, no further explanation will be given In 
the present description. 

The floor reaction force moment vertical component 
compensation amount means the compensation amount of a 
floor reaction force moment vertical component that can be 
added to the floor reaction force moment generated by a 
motion of a desired gait If the desired gait with a floor 
reaction force moment vertical component limited to a 
floor reaction force moment vertical component permissible 
range (this Is set In S3026} for generating a gait Is 
supposedly generated In the gait generating device 100. 
Hence, the permissible range of a floor reaction force 
moment vertical component compensation amount cannot be 
widely set unless the floor reaction force moment vertical 
component permissible range for generating a gait is set 
to be sufficiently narrower than an actual friction limit. 

The permissible range of a floor reaction force 
moment vertical component compensation cunount may be set 
to be similar to the floor reaction force moment vertical 
component permissible range for generating a gait (refer 
to the aforesaid Fig. 41). For a floating period of the 
running gait shown in the aforesaid Fig. 5, the 
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permissible range of a floor reaction force moment 
vertical component compensation amount for compliance 
control Is set to a range having an upper limit value of 
zero and a lower limit value of zero. 

Returning to Fig. 56, after the paremieters defining 
the permissible ranges of the floor reaction force moment 
horizontal component about the desired ZMP for compliance 
control and the permissible range of the floor reaction 
force moment vertical component compensation amount are 
determined In S3030 as described above, or If the 
determination result of S3016 Is NO, then the processing 
proceeds to S3032 wherein a current time gait 
Instantaneous value Is determined. In S3032, a current 
time gait Instantaneous value is determined such that a 
model manipulation floor reaction force moment horizontal 
component determined according to the above Equation d27a 
is generated about the desired ZMP. However, the current 
time gait instantaneous value is determined such that the 
floor reaction force moment vertical component that 
balances with the current time gait (the resultant force 
of the Inert lal force of a motion of the current time gait 
and gravity balances with the vertical component of an 
inert lal force moment generated about the desired ZMP) 
does not exceed the permissible range of the floor 
reaction force moment vertical component. 

Specifically, gait instantaneous values are 
determined according to the flowcharts shown in Fig. 57 
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and Fig. 58. More specifically. In S3030, the processing 
from S3400 to S3411 of Fig. 57 Is executed. The 
processing from S3400 to S3411 Is exactly the same as that 
from S1400 to S1411 of Fig. 45 mentioned above. 
5 Then, the processing proceeds to S3412 wherein the 

Instantaneous values (the current time values at the 
current time t) of the floor reaction force moment 
horizontal component permissible range [Mxymln, Mxymax] 
and a floor reaction force moment vertical component 

10 compensation amount permissible range [Mzcmln, Mzcmax] at 
the current time are determined on the basis of the 
parameters of the floor reaction force moment horizontal 
component permissible range for compliance control and the 
floor reaction force moment vertical component 

15 compensation amount permissible range that have been 
determined In S3030 of the aforesaid Fig. 56. 

The determined floor reaction force moment horizontal 
component permissible range Is sent to the compensating 
total floor reaction force moment horizontal component 

20 distributor 110 (refer to Fig. 53). Then, the current 

time value (the value at the current time t) of the model 
manipulation floor reaction force moment calculated 
according to the above Equation d27a by the distributor 
110 Is supplied to the gait generating device 100. 

25 The determined permissible range of the floor 

reaction force moment vertical component compensation 
amount Is supplied to the aforesaid model manipulation 



- 231 - 



floor reaction force moment vertical component determiner 
111 (refer to Pig. 53). The current time value (the value 
at the current time t) of the model manipulation floor 
reaction force moment vertical component calculated 
according to the aforesaid Equation d26b by the model 
manipulation floor reaction force moment vertical 
component determiner 111 Is supplied to the gait 
generating device 100. 

Subsequently, the processing of the gait generating 
device 100 proceeds to S3414 wherein the horizontal body 
acceleration and the body posture Inclination angular 
acceleration of the current time gait eu:e determined so 
that the model manipulation floor reaction force moment 
horizontal component supplied from the compensating total 
floor reaction force moment distributor 110 Is generated 
about the desired ZMP. However, the horizontal body 
acceleration and the body posture angular acceleration 
(the body Inclination angular acceleration) are determined 
such that the floor reaction force horizontal component Fx 
does not exceed the floor reaction force horizontal 
component permissible range [Fxmln, Fxmax] determined In 
S3410. 

In other words, the horizontal body acceleration and 
the body posture angular acceleration (the body 
Inclination angular acceleration) of the current time gait 
are determined so that the moment horizontal component 
generated about the desired ZMP by the resultant force of 
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the Inert ial force of a motion of the robot 1 and the 
gravity will be the moment with a reversed sign of the 
model manipulation floor reaction force moment horizontal 
component. However, the horizontal body acceleration and 
the body posture inclination angular acceleration are 
determined such that the force with the reversed sign of 
the horizontal component of the inertial force does not 
exceed the floor reaction force horizontal component 
permissible range [Fxmin, Fxmax] . 

In S3414, specifically, the horizontal body 
acceleration and the body posture angular acceleration are 
determined according to the flowchart shown in Fig. 58. 
In this flowchart, the same processing as that shown in 
the aforesaid Fig. 26 is performed except for S3 104 and 
S3130. Unlike S504 and S530 of Fig. 26, S3104 and S3130 
determine a horizontal body acceleration (atmp in S3104 or 
a in S3130) required for the aforesaid model manipulation 
floor reaction force moment horizontal component to be 
generated about the desired ZMP of the current time (time 
k) in a case where the robot 1 is made to perform a motion 
of the body translational mode, setting the angular 
acceleration of the body inclination mode to zero (to be 
more precise, matching the angular acceleration of the 
body inclination mode with a reference body posture 
angular acceleration) from the last time instant gait 
state (the gait state at time k-1) of the robot 1. 
The rest of the processing is the same as the 
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processing shown in Fig. 26. 

Thus, after the processing of S3414 Is completed, the 
processing proceeds to S3416, wherein the same processing 
as that of S1414 of Pig. 45 Is carried out to determine 
the horizontal body position and the body posture 
Inclination angle (specifically, the current time values 
thereof at the current time t). 

Subsequently, the processing proceeds to S3418 
wherein the same processing as that of S1416 of Fig. 45 Is 
carried out to determine an antiphase arm swing angle and 
angular velocity of the current time gait (specifically, 
the current time values thereof at the current time t) . 

Thus, the processing of S3032 of Fig. 56 Is completed. 

Then, the processing proceeds to S3034 of Fig. 56 to 
correct the current time gait Instantaneous value 
generated In S3 03 2 so as to additionally generate a model 
manipulation floor reaction force moment vertical 
component about the desired ZMP. 

Specifically, a correction amount paadd of an 
antiphase arm swing angular acceleration corresponding to 
the model manipulation floor reaction force moment 
vertical component Is determined according to the 
following equation. 

Correction amount Paadd of antiphase arm swing angular 
acceleration = Model manipulation floor reaction force 
moment vertical component / Equivalent Inertlal moment 
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AMaz of antiphase arm swing motion 

Further, |3aadd Is Integrated over the period of a 
control cycle to determine a correction amount of the 
antiphase arm swing angular velocity, and then this Is 
Integrated to determine a correction amount of the 
antiphase arm swing angle. 

Lastly, the correction eunount of the antiphase arm 
swing angular velocity and the correction amount of the 
antiphase arm swing angle are added to the antiphase arm 
swing angle and the angular velocity, respectively, of the 
current time gait generated In S3032, thereby correcting 
the antiphase arm swing angle and the angular velocity of 
the current time gait. 

Subsequently, the processing proceeds to S3036 to add 
the control cycle At to time t, and returns to S3014 to 
wait for a timer Interrupt for each control cycle. 

In the second reference example, as described above, 
the processing for generating a desired gait is carried 
out in the gait generating device 100, and Instantaneous 
values of a desired body position/posture, a desired foot 
position/posture, a desired arm posture (including an 
antiphase arm swing angle), a desired ZMP, and a desired 
total floor reaction force are determined and output 
sequentially . 

In this case, regarding the desired total floor 
reaction force, only a component thereof that is necessary 
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for compliance control may be output. The desired ZMP Is 
deliberately listed here as an output although It is 
included in the desired total floor reaction force, 
because it is particularly important. The model 
manipulation floor reaction force moment horizontal 
component is not output as a desired floor reaction force 
to the composite -compliance control unit (the portion 
encircled by a dashed line in Fig. 53). More specifically, 
for the compliance control, the desired floor reaction 
force aimed at a zero floor reaction force moment 
horizontal component about the desired ZMP (the desired 
floor reaction force satisfying the desired ZMP in the 
original meaning) is output from the gait generating 
device 100. 

The floor reaction force moment vertical component of 
the current time gait that has been corrected in S3034 is 
output as a desired value from the gait generating device 
100 to the composite-compliance control unit. 

As a first action of the second reference example 
explained above, a motion of a desired gait is generated 
such that a model manipulation floor reaction force moment 
horizontal component is produced about a desired ZMP, 
while the floor reaction force of the actual robot 1 is 
controlled so as to prevent the model manipulation floor 
reaction force moment horizontal component from being 
added. Hence, there is an imbalance (unbalance) between 
the motion of the desired gait and the floor reaction 
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force by the differential portion of the model 
manipulation floor reaction force moment horizontal 
component* This Is equivalent to applying a floor 
reaction force moment horizontal component, which has a 
sign reversed from the sign of the model manipulation 
floor reaction force moment horizontal component, to the 
actual robot 1 from the aspect of the effect for 
converging a difference between the body posture 
Inclination angle of the actual robot 1 and the body 
posture Inclination angle of a desired gait. 

In other words, the actual robot 1 can be converged 
to a corrected desired gait (the gait for converging the 
difference between the body posture Inclination angle of 
the actual robot 1 and the body posture Inclination angle 
of a desired gait) by determining a model manipulation 
floor reaction force moment horizontal component as 
appropriate. This means that the posture Inclination of 
the actual robot 1 can be stabilized. 

As a second action, the sum of a moment with a 
reversed sign of a model manipulation floor reaction force 
moment horizontal component and a desired floor reaction 
force moment horizontal component for compliance control 
provides a total inclination restoring force (a force for 
restoring an actual body posture inclination angle of the 
robot 1 to a desired body posture inclination angle) . 
This means that the difference between a desired floor 
reaction force moment horizontal component for compliance 
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control and a model manipulation floor reaction force 
moment horizontal component provides a total posture 
Inclination restoring force. 

As a third action, a model manipulation floor 
5 reaction force moment horizontal component can take any 
value. Ignoring the range In which a ZMP can exist, thus 
making It possible to generate an extremely high posture 
Inclination restoring force. 

As a fourth action, a body translatlonal acceleration 

10 of the body translatlonal mode and a body posture 

Inclination angular acceleration of the body Inclination 
mode are determined such that a floor reaction force 
horizontal component does not exceed a floor reaction 
force horizontal component permissible range. This makes 

15 It possible to prevent slippage of the robot 1 even In a 
period wherein a large floor reaction force horizontal 
component cannot be generated, such as Immediately before 
a supporting leg 2 leaves a floor or Immediately after it 
lands on a floor in a running gait, or when the robot 1 

20 travels on a floor with a small frlctlonal coefficient. 

As a fifth action, the permissible range of a floor 
reaction force horizontal component Is set to zero In the 
period wherein the translatlonal force vertical component 
of a floor reaction force Is zero, that Is, In the period 

25 wherein neither of the legs Is In contact with the ground, 
so that a posture Inclination Is automatically restored by 
depending upon the body Inclination mode rather than 
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depending upon the body trans latlonal mode according to 
the algorithm of the second reference example discussed 
above, thus performing the posture restoration without 
depending upon a frlctlonal force between a floor and a 
5 sole. Accordingly, even in this period (floating period), 
the posture inclination restoring action effectively works, 
unlike the method wherein only the body translatlonal mode 
is merely corrected. Incidentally, at this time, the gait 
is generated so that the floor reaction force horizontal 

10 component becomes zero; therefore, the total center-of- 

gravlty horizontal acceleration of the gait will be zero. 

Further, as a sixth action, a model manipulation 
floor reaction force moment horizontal component is not 
output as a desired floor reaction force for compliance 

15 control, as described above. More specifically, even when 
a gait is generated to produce a model manipulation floor 
reaction force moment horizontal component about a desired 
ZMP, a desired floor reaction force intended for setting a 
floor reaction force moment horizontal component about the 

20 desired ZMP to zero for compliance control is supplied 
from the gait generating device 100. Thus, the floor 
reaction force control by the compliance control will not 
be Interfered with, allowing the floor reaction force 
control to be properly conducted by compliance control. 

25 To be more specific, it is possible to prevent or restrain 
the occurrence of a problem, such as one in that an 
originally designed property of a foot 22 to contact the 
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ground is deteriorated, or the sole of a foot 22 
Incompletely contacts the ground. 

As it will be discussed hereinafter, a desired floor 
reaction force moment horizontal component for compliance 
5 control about a desired ZMP will be determined so as not 
to exceed a floor reaction force moment horizontal 
component permissible range also in a third reference 
example and after. 

Incidentally, the first to the sixth actions are the 

10 same techniques in PCT/ JP03/00435 previously proposed by 
the present applicant. 

As a seventh action, a motion of a desired gait is 
generated such that a model manipulation floor reaction 
force moment vertical component is additionally produced 

15 about a desired ZMP, and the actual floor reaction force 
of the actual robot 1 is controlled by composite- 
compliance control to approximate to a desired value, the 
desired value being obtained by adding the compensating 
total floor reaction force moment vertical component Mdmdz 

20 to a desired floor reaction force moment vertical 

component that balances with the desired gait to which a 
model manipulation floor reaction force moment vertical 
component has been added by the gait generating device 100. 
As Mdmdz increases, a model manipulation floor reaction 

25 force moment vertical component in the opposite direction 
from Mdmdz is added to the desired gait. Hence, even when 
the actual floor reaction force is controlled to 
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approximate it to the aforesaid desired value by the 
composite -compliance control, the vertical component of 
the moment of the actual floor reaction force will not be 
excessive. As a result, the effect can be Implemented In 
5 which the difference between the body posture yaw angle 

and/or the body posture yaw angular velocity of the actual 
robot 1 and the body posture yaw angle and/or the yaw 
angular velocity of a desired gait Is converged to zero 
without causing the actual robot 1 to spin. 

10 In other words, appropriately determining the model 

manipulation floor reaction force moment vertical 
component makes It possible to converge the actual robot 1 
to the corrected desired gait (the gait that converges the 
difference between the body posture yaw angle and/or the 

15 body posture yaw angular velocity of the actual robot 1 
and the body posture yaw angle and/or the yaw angular 
velocity of the desired gait to zero), while preventing 
the actual robot 1 from spinning. This means that the yaw 
rotation of the actual robot 1 can be stabilized. 

20 As an eighth action, the compensating total floor 

reaction force moment vertical component Mdmdz provides a 
total yaw rotation restoring force. The compensating 
total floor reaction force moment vertical component Mdmdz 
is determined according to a feedback control law so as to 

25 approximate a yaw angle error and/ or a yaw angular 
velocity error to zero, thus making it possible to 
approximate the yaw angle error and/ or a yaw angular 
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velocity error to zero while ensuring control stability of 
yaw angle errors. 

As a ninth action, a model manipulation floor 
reaction force moment vertical component may take any 
5 value, ignoring the permissible range of the floor 
reaction force moment vertical component (or the 
frictional limit), so that an extremely high posture yaw 
rotation restoring force can be generated. 

As a tenth action, a final desired floor reaction 

10 force moment vertical component is determined for 

compliance control such that it does not exceed the sum of 
the permissible range of a floor reaction force moment 
vertical component and the permissible range of a floor 
reaction force moment vertical component compensating 

15 amount . This makes it possible to properly conduct the 
floor reaction force control based on the compliance 
control and therefore makes it possible to prevent the 
robot 1 from spinning even in a period wherein a large 
floor reaction force moment vertical component cannot be 

20 generated, such as immediately before a supporting leg 2 

leaves a floor or immediately after it lands on a floor in 
a running gait, or when the robot 1 travels on a floor 
with a small frictional coefficient. To be more specific, 
it is possible to prevent or restrain the occurrence of a 

25 problem, such as one in that an originally designed 
property of a foot 22 to contact the ground is 
deteriorated, or the sole of a foot 22 incompletely comes 
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in contact with the ground. 

As an eleventh action, the permissible range of a 
floor reaction force moment vertical component and the 
permissible range of a floor reaction force moment 
5 vertical component compensation amount are set to zero in 
the period wherein the translatlonal force vertical 
component of a floor reaction force is zero, that is, in 
the period wherein neither of the legs is in contact with 
the ground, so that yaw rotation is automatically restored 

10 by depending upon the antiphase arm swing mode rather than 
depending on an actual floor reaction force moment 
vertical component according to the algorithm of the 
present second reference example discussed above, thus 
performing the restoration of yaw rotation without 

15 depending upon a frictional force between a floor and a 

sole. Accordingly, even in this period (floating period), 
the yaw rotation restoring action effectively works, 
unlike the method wherein the desired floor reaction force 
moment vertical component for compliance control is merely 

20 corrected. 

As a twelfth action, if a gait generated such that 
the moment horizontal component produced about a desired 
ZMP is zero is referred to as an original gait, and a gait 
generated such that the moment horizontal component 

25 produced about a desired ZMP provides a model manipulation 
floor reaction force moment horizontal component and a 
model manipulation floor reaction force moment vertical 
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component is additionally produced in the moment vertical 
component produced about the desired ZMP, as in the 
aforesaid second reference example, is referred to as a 
corrected gait, then the original gait and the corrected 
5 gait will usually be different gaits. The original gait 

is set so that it gradually approximates to a normal gait, 
and therefore, the corrected gait is usually a gait that 
does not gradually approximate to a normal gait. 

However, immediately following the completion of the 

10 generation of a current time gait (corrected gait), the 
processing from S3020 to S3028 is carried out again to 
determine new current time gait parameters such that a new 
current time gait having a terminal state of the corrected 
gait as its new initial state gradually approximates a 

15 normal gait newly set. This makes it possible to continue 
generating gaits with continuously (long-range) guaranteed 
stability. 

The twelfth action described above is substantially 
the same technique as that previously proposed in 

20 PCT/JP03/00435 by the present applicant. In addition, 

however, the present second reference example provides the 
following action. The parameters related to an antiphase 
arm swing angle trajectory of a new current time gait are 
determined such that the antiphase arm swing angle 

25 trajectory of the new current time gait, which uses the 
terminal state of the antiphase arm swing angle and 
angular velocity corrected to restore the yaw angle 
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rotation as the new Initial state, gradually approximates 
to the antiphase arm swing angle trajectory of the normal 
gait that Is newly set. This makes It possible to 
continue generating gaits with continuously (long-range) 
5 guaranteed stability of the antiphase arm swing angle. 

In the present second reference example. If the 
compensating total floor reaction force moment horizontal 
component Mdmdxy takes a value within a floor reaction 
force moment horizontal component permissible range, then 

10 the model manipulation floor reaction force moment 

horizontal component will be zero. Alternatively, however, 
the model manipulation floor reaction force moment 
horizontal component at this time may be set on the basis 
of the state simounts of the dynamic model shown In Fig. 12 

15 (e.g., the center-of -gravity position of the robot on the 

dynamic model, and the position of the body mass point 3m). 

Further, in the present second reference example, if 
the compensating total floor reaction force moment 
vertical component Mdmdz takes a value within a floor 

20 reaction force moment vertical component compensating 
amount permissible range, then the model manipulation 
floor reaction force moment vertical component 
compensating amount will be zero. Alternatively, however, 
the model manipulation floor reaction force moment 

25 vertical component compensating amount at this time may be 
set on the basis of the state amounts of the dynamic model 
shown in Fig. 12 (e.g., the antiphase arm swing angle and 
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angular velocity, and the body yaw angle and angular 
velocity of the robot 1 on the dynamic model ) . 

Referring now to Fig. 59 through Fig. 62, a third 
reference example of the present invention will be 
explained. In the explanation of the third reference 
example, the like constituent parts or like functional 
parts as those in the aforesaid first reference example or 
the aforesaid second reference example will be assigned 
like reference numerals as those in the aforesaid first 
reference example or the aforesaid second reference 
example, and the explanation thereof will be omitted. In 
the third reference example, the aspects explained with 
reference to Fig. 1 to Fig. 3 and Fig. 5 to Fig. 12 in the 
aforesaid first reference example are identical to those 
in the aforesaid first reference example. 

An outline of the aspects of the third reference 
example that are different from those of the aforesaid 
first reference example and the second reference example 
will be explained. An original gait and a corrected gait 
are generated at the same time. The corrected gait is 
obtained by correcting an original gait to stabilize a 
body posture (an inclination angle and a yaw angle) of the 
actual robot 1. Further, in the corrected gait, if the 
corrected gait still has an allowance (an allowance in a 
floor reaction force moment that can be generated about a 
desired ZMP) after generating a floor reaction force 
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moment required for restoring a posture by compliance 
control, then It Is determined to converge to the original 
gait as much as possible, using the allowance. 

A block diagram showing a functional construction of 
5 a control unit 60 In the third reference example Is shown 
In Fig. 59. In the third reference example, a 
compensating total floor reaction force moment horizontal 
component Mdmdxy determined by a posture Inclination 
stabilization control calculator 112 Is supplied to a gait 

10 generating device 100. 

A compensating total floor reaction force moment 
vertical component Mdmdz determined by a yaw stabilization 
control calculator 113 Is also supplied to the gait 
generating device 100. 

15 Further, a compensating total floor reaction force 

moment distributor 120 that determines a model 
manipulation floor reaction force moment (a horizontal 
component and a vertical component) and a desired floor 
reaction force moment (a horizontal component and a 

20 vertical component) for compliance control on the basis of 
the Mdmdxy and Mdmdz Is Incorporated In the gait 
generating device 100. The desired floor reaction force 
moment for compliance control Is output from the gait 
generating device 100 to a composite -compliance operation 

25 determiner 104. And, as will be discussed hereinafter, 
the compensating total floor reaction force moment 
distributor 120 in the gait generating device 100 performs 
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more complicated processing than that performed by the 
compensating total floor reaction force moment horizontal 
component distributor 110 and the model manipulation floor 
reaction force moment vertical component determiner model 
5 111 of the aforesaid second reference example. The 

functional construction of the control unit 60 except for 
the above Is Identical to that In the second reference 
example • 

Fig. 60 shows the flowchart of the main routine 

10 processing of the gait generating device 100 In the third 
reference example. 

In this Fig. 60, the same processing as that from 
SOlO to S028 of the main flowchart (Fig. 13) of the 
aforesaid first reference example Is carried out from 

15 S2010 to S2028. In the Initialization in S800 of the 
flowchart of Fig. 43, which is the subroutine of S028 
(S2028 in the present embodiment), the initial state of a 
current time gait is obtained by converting the terminal 
state of the last time corrected gait (the final gait that 

20 the gait generating device 100 outputs) into a current 
time's supporting leg coordinate system. The terminal 
state of the original gait determined in S2032, which will 
be discussed hereinafter, is not used in S800 of the 
subroutine of S2028. 

25 Subsequently, the processing proceeds to S2030 

wherein the floor reaction force moment horizontal 
component permissible range for compliance control is 
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determined. The method for determining the floor reaction 
force moment horizontal component permissible range Is the 
same as that In S3032 (Fig. 56) of the second reference 
example . 

5 After completing the processing of S2030, or If the 

determination result of S2016 Is NO, then the program 
proceeds to S2032 wherein an Instantaneous value of the 
original gait (the current time value at time t) Is 
determined. The original gait Is a gait that Is generated 

10 so that the floor reaction force moment horizontal 
component about a desired ZMP Is zero. 

This original gait Is generated according to an 
algorithm obtained by partly changing the subroutine 
processing of S3032 of Fig. 56 in the aforesaid second 

15 reference example. More specifically. In S3104 and S3130 
of Fig. 58, which Is the subroutine processing In S3032 
(precisely, the subroutine processing of S3414 of Fig. 57, 
which Is the subroutine processing of S3032), a horizontal 
body acceleration atmp is determined, the model 

20 manipulation floor reaction force moment horizontal 

component being zero (the desired floor reaction force 
moment horizontal component about a desired ZMP being 
zero). The processing except for this may be the same as 
the processing of S3032 of Fig. 56. 

25 Subsequently, the processing proceeds to S2034 

wherein the instantaneous value of a corrected gait is 
determined. The corrected gait is the desired gait 
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finally output from the gait generating device 100 • 

The processing of S2034 Is Implemented by the 
subroutine processing Illustrated by the flowchart of Fig. 
61. This will be explained In detail below. 
5 First, from S2100 to S2111, the same processing as 

that of S3400 to S3411 of Fig. 57 explained In the second 
reference example Is carried out. 

Subsequently, the processing proceeds to S2112 
wherein the floor reaction force moment horizontal 

10 component permissible range [Mxymln, Mxymax] at the 

current time Is determined on the basis of gait parameters. 
This Is carried out In the same manner as that for 
determining the floor reaction force moment horizontal 
component permissible range [Mxymln, Mxymcix] In S3 4 12 of 

15 Fig. 57. 

Subsequently, the processing proceeds to S2114 
wherein a model manipulation floor reaction force moment 
(a horizontal component and a vertical component), a 
desired floor reaction force moment for compliance control, 

20 a horizontal body acceleration, a body posture Inclination 
angular acceleration, and an antiphase arm swing angular 
acceleration are determined such that the conditions of a 
floor reaction force moment horizontal component 
permissible range, a floor reaction force moment vertical 

25 component permissible range, and a floor reaction force 
horizontal component permissible range are satisfied. 
The details of S2114 will be explained below in 
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conjunction with the flowchart of Fig. 62 that Illustrates 
the processing. 

First, in S2200, the difference in horizontal body 
position between models, which is the difference between 
5 the horizontal body position of the corrected gait and the 
horizontal body position of the original gait, is 
determined. At this point, the current time value (the 
value at time t) of the horizontal body position of the 
corrected gait has not yet been determined. In S2200, 
10 therefore, the last time value (the last value determined 
in the control cycle at time t~At) of the horizontal body 
position of the corrected gait, and the last time value 
(the value determined in S2032 in the control cycle at 
time t-At) or a current time value (the value determined 
15 in S2032 in the control cycle at time t) of the horizontal 
body position of the original gait are used to calculate 
the difference in horizontal body position between models. 

Subsequently, the processing proceeds to S2202 
wherein the difference in body posture inclination angle 
20 between models, which is the difference between the body 
posture inclination angle of the corrected gait and the 
body posture inclination angle of the original gait, is 
determined. In this S2202, the last time value of the 
body posture inclination angle of the corrected gait and 
25 the last time value or the current time value of the body 
posture inclination angle of the original gait are used to 
determine the difference in body posture inclination angle 
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between models, as In the case of the processing for 
calculating the difference in horizontal body position 
between models in S2200. 

Subsequently, the processing proceeds to S2204 
5 wherein the difference in antiphase arm swing angle 
between models, which is the difference between the 
antiphase arm swing angle of the corrected gait and the 
antiphase arm swing angle of the original gait, is 
determined. In this S2204, the last time value of the 

10 antiphase arm swing angle of the corrected gait and the 

last time value or the current time value of the antiphase 
arm swing angle of the original gait are used to determine 
the difference in antiphase arm swing angle between models, 
as in the case of the processing for calculating the 

15 difference in horizontal body position between models in 
S2200. 

Subsequently, the processing proceeds to S2206 
wherein, based on the difference in horizontal body 
position between models, a required value Mpfdmd of model 

20 horizontal body position stabilization floor reaction 
force moment that is necessary for converging the 
difference to zero is determined. If the floor reaction 
force moment for generating a horizontal body acceleration 
of the body translational mode of the corrected gait is 

25 merely matched with the floor reaction force moment for 
generating a horizontal body acceleration of the body 
translational mode of the original gait, then the 
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difference In horizontal body position between models 
diverges. The required value Mpfdmd of model horizontal 
body position stabilization floor reaction force moment 
has a meaning as a moment resulting from subtracting the 
5 floor reaction force moment for generating the horizontal 
body acceleration of the body translational mode of the 
original gait from the floor reaction force moment 
generated when a motion is made to return the horizontal 
body position of the corrected gait to the horizontal body 

10 position of the original gait by the aforesaid body 
translational mode. 

Specifically, the required value Mpfdmd of model 
horizontal body position stabilization floor reaction 
force moment is determined according to, for example, the 

15 feedback control law of the equation given below. In this 
example, the PD control law is used as the feedback 
control law; alternatively, however, other feedback 
control laws, such as PID, may be applied. 

20 Mpfdmd = Kmp * Difference in horizontal body position 

between models + Kmpv * Temporal differential value of the 
difference in horizontal body position between models 

Equation d28 

where Kmp and Kmpv denote feedback gains (a 
25 proportional gain and a differential gain) 

Subsequently, the processing proceeds to S2208 
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wherein, based on the difference In body posture 
inclination angle between models, a required value Mrfdmd 
of model body posture Inclination angle stabilization 
floor reaction force moment that Is necessary for 
5 converging the difference to zero Is determined. If the 
floor reaction force moment for generating a body posture 
Inclination angular acceleration of the body Inclination 
mode of the corrected gait Is merely matched with the 
floor reaction force moment for generating a body posture 

10 Inclination angular acceleration of the body Inclination 
mode of the original gait, then the difference In body 
posture Inclination angle between models does not converge 
to zero* The required value Mrfdmd of the floor reaction 
force moment for stabilizing a model body posture 

15 Inclination angle has a meaning as a moment resulting from 
subtracting the floor reaction force moment for generating 
the body posture Inclination angle acceleration of the 
body Inclination mode of the original gait from the floor 
reaction force moment generated when a motion is made to 

20 return the body posture inclination angle of the corrected 
gait to the body posture inclination angle of the original 
gait by the aforesaid body inclination mode. 

Specifically, the required value Mrfdmd of the floor 
reaction force moment for stabilizing a model body posture 

25 inclination angle is determined according to, for example, 
the feedback control law of the equation given below. In 
this example, the PD control law is used as the feedback 
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control law; alternatively, however, other feedback 
control laws, such as PID, may be applied. 

Mrfdmd = Kmr * Difference in body posture Inclination 
5 angle between models + Kmrv * Temporal differential value 
of the difference in body posture inclination angle 
between models 

Equation d29 

where Kmr and Kmrv denote feedback gains (a 
10 proportional gain and a differential gain) 

Subsequently, the processing proceeds to S2210 
wherein, based on the difference in antiphase arm swing 
angle between models, a required value Mafdmd of the floor 

15 reaction force moment for stabilizing a model antiphase 
arm swing angle that is necessary for converging the 
difference to zero is determined. If the floor reaction 
force moment for generating an antiphase arm swing angular 
acceleration of the antiphase arm swing mode of the 

20 corrected gait is merely matched with the floor reaction 

force moment for generating an antiphase arm swing angular 
acceleration of the antiphase arm swing mode of the 
original gait, then the antiphase arm swing angle between 
models does not converge to zero. The required value 

25 Mafdmd of the floor reaction force moment for stabilizing 
a model antiphase arm swing angle has a meaning as a 
moment resulting from subtracting the floor reaction force 
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moment for generating the antiphase arm swing angular 
acceleration of the antiphase arm swing mode of the 
original gait from the floor reaction force moment 
generated when a motion Is made to return 1:he antiphase 
5 arm swing angle of the corrected gait to the antiphase arm 
swing angle of the original gait by an antiphase arm swing 
mode. 

Specifically, the required value Mafdmd of the floor 
reaction force moment for stabilizing a model antiphase 
10 arm swing angle Is determined according to, for example, 
the feedback control law of the equation given below. In 
this example, the PD control law Is used as the feedback 
control law; alternatively, however, other feedback 
control laws, such as PID, may be applied. 

15 

Mafdmd = Ka * Difference In antiphase arm swing angle 
between models + Kav * Temporal differential value of the 
difference In antiphase arm swing angle between models 

Equation d29b 

20 where Kar and Kav denote feedback gains (a 

proportional gain and a differential gain). 

Incidentally, the moment obtained by subtracting the 
floor reaction force moment horizontal component for 
25 generating a horizontal body acceleration of the body 
translatlonal mode of an original gait from the floor 
reaction force moment horizontal component generated by 
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the body translatlonal mode of a finally determined 
corrected gait is called a floor reaction force moment for 
stabilizing a model horizontal body position. Further, 
the moment obtained by subtracting the floor reaction 
5 force moment horizontal component for generating a body 
posture inclination angular acceleration of the body 
inclination motion mode of an original gait from the floor 
reaction force moment horizontal component generated by 
the body inclination motion mode of a finally determined 

10 corrected gait is called a floor reaction force moment for 
stabilizing a model body posture inclination angle. 
Further, the moment obtained by subtracting the floor 
reaction force moment vertical component for generating an 
antiphase arm swing angular acceleration of the antiphase 

15 arm swing mode of an original gait from the floor reaction 
force moment vertical component generated by the antiphase 
arm swing mode of a finally determined corrected gait is 
called a floor reaction force moment for stabilizing a 
model antiphase arm swing angle. 

20 Meanwhile, linearity approximately holds between a 

perturbation motion and a perturbation floor reaction 
force. In other words, the floor reaction force of a 
motion obtained by adding a different perturbation motion 
to the motion of an original gait substantially agrees 

25 with the floor reaction force of the original gait to 

which the perturbation floor reaction force generated by 
each perturbation motion has been added. In the antiphase 
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arm swing mode, a floor reaction force moment horizontal 
component remains unchanged. Hence, the following 
equation approximately holds. 

Model manipulation floor reaction force moment horizontal 
component = Model horizontal body position stabilization 
floor reaction force moment + Model body posture 
Inclination angle stabilization floor reaction force 
moment 

Equation d30 

Taking Into account that the Equation d30 
approximately holds and a floor reaction force moment 
vertical component changes In proportion to an antiphase 
arm swing angular acceleration. If a model horizontal body 
position stabilization floor reaction force moment Is 
determined so that It agrees with or approximates as much 
as possible to the required value Mpfdmd of model 
horizontal body position stabilization floor reaction 
force moment , and a model body posture Inclination angle 
stabilization floor reaction force moment Is determined so 
that It agrees with or approximates as much as possible to 
the required value Mrf dmd of a model body posture 
Inclination angle stabilization floor reaction force 
moment, and a model antiphase arm swing angle 
stabilization floor reaction force moment Is determined so 
that It agrees with or approximates as much as possible to 
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the required value Mafdmd of a model antiphase arm swing 
angle stabilization floor reaction force moment, then a 
model manipulation floor reaction force moment appropriate 
for a corrected gait can be generated to converge the 
5 horizontal body acceleration and the body posture 

inclination angular acceleration of a corrected gait to 
possible ranges for the horizontal body acceleration and 
the body posture Inclination angular acceleration, 
respectively, of an original gait, while satisfying the 

10 restoring conditions shown below. 

Thus, after S2210, the processing proceeds to S2212 
wherein a model horizontal body position stabilization 
floor reaction force moment (the floor reaction force 
moment of the body translational mode) , a model body 

15 posture inclination angle stabilization floor reaction 

force moment (the floor reaction force moment of the body 
inclination mode), and a model antiphase arm swing angle 
stabilization floor reaction force moment are determined 
so as to satisfy the conditions shown below (these are 

20 called "restoring conditions') as much as possible. 

Furthermore, the horizontal body acceleration, the body 
posture inclination angular acceleration, and the 
antiphase arm swing angular acceleration of a corrected 
gait are determined so as to satisfy the definitions of 

25 the model horizontal body position stabilization floor 

reaction force moment, the model body posture inclination 
angle stabilization floor reaction force moment, and the 
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model antiphase arm swing angle stabilization floor 
reaction force moment described above. Regarding the 
restoring conditions shown below, conditions with smaller 
numbers have higher priorities. In other words. If 
conflicting. Incompatible conditions are encountered, then 
a condition with a smaller number will be preferentially 
satisfied (met). However, restoring conditions of 1, 2 
and 3 must always be satisfied (met). 

Restoring condition 1) The sum of the compensating 
total floor reaction force moment horizontal component 
Mdmdxy and a model manipulation floor reaction force 
moment (this corresponds to a desired floor reaction force 
moment horizontal component for compliance control If the 
above Equation d27b holds) does not exceed a floor 
reaction force moment horizontal component permissible 
range . 

Restoring condition 2) The floor reaction force 
horizontal component of a corrected gait does not exceed a 
floor reaction force horizontal component permissible 
range . 

Restoring condition 3) The sum of the floor reaction 
force moment vertical component of a corrected gait and a 
compensating total floor reaction force moment vertical 
component Mdmdz (this corresponds to a desired floor 
reaction force moment vertical component for compliance 
control) does not exceed a floor reaction force moment 
vertical component permissible range. 
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Restoring condition 4) A model body posture 
inclination angle stabilization floor reaction force 
moment agrees with or is close as much as possible to a 
required value Mrfdmd of model body posture inclination 
5 angle stabilization floor reaction force moment. This 
condition is the condition for the body posture 
inclination angle of a corrected gait to converge to the 
body posture inclination angle of an original gait 
( originally planned gait ) . 

10 Restoring condition 5) A model horizontal body 

position stabilization floor reaction force moment agrees 
with or is close as much as possible to a required value 
Mpfdmd of model horizontal body position stabilization 
floor reaction force moment. This condition is the 

15 condition for a horizontal body position of a corrected 
gait to converge to the horizontal body position of an 
original gait ( originally planned gait ) . 

Restoring condition 6) A model antiphase arm swing 
angle stabilization floor reaction force moment agrees 

20 with or is close as much as possible to a required value 
Mafdmd of model antiphase arm swing angle stabilization 
floor reaction force moment. This condition is the 
condition for the antiphase arm swing angle of a corrected 
gait to converge to the antiphase arm swing angle of an 

25 original gait (originally planned gait). 

Restoring condition 7) A model body posture 
inclination angle stabilization floor reaction force 
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moment, a model horizontal body position stabilization 
floor reaction force moment, and a model antiphase arm 
swing angle stabilization floor reaction force moment are 
all continuous. 

5 The processing of S2212 for determining a horizontal 

body acceleration, a body posture Inclination angle 
acceleration, an antiphase arm swing angular acceleration, 
etc. that satisfy the restoring conditions 1 through 6 
described above Is carried out, for example, as follows. 

10 First, In order to satisfy the aforesaid restoring 

conditions 1, 2, 4, and 5, a model horizontal body 
position stabilization floor reaction force moment and a 
model body posture Inclination angle stabilization floor 
reaction force moment are determined, and further a 

15 horizontal body acceleration and a body posture 

Inclination angular acceleration are detexrmlned. This 
processing Is discussed In detail In the art of 
PCT/JP03/00435 previously proposed by the present 
applicant, so that the explanation thereof will be omitted 

20 here. 

Subsequently, the model antiphase arm swing 
stabilization floor reaction force moment Is determined 
such that the aforesaid restoring conditions 3 and 6 are 
satisfied, and further, the antiphase arm swing angular 
25 acceleration Is determined. 

Specifically, a floor reaction force moment vertical 
component about a desired ZMP that Is generated If a 
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motion is provisionally implemented at the horizontal body 
acceleration and the body posture inclination angular 
acceleration determined as described above and at an 
antiphase arm swing angular acceleration Paorg of an 
original gait (dynamically balancing the motion) is 
determined. Hereinafter, this will be referred to as a 
floor reaction force moment vertical component without 
correction. 

Subsequently, a sum Msumz of a floor reaction force 
moment vertical component without correction, the required 
value Mafdmd of model antiphase arm swing angle 
stabilization floor reaction force moment, and a 
compensating total floor reaction force moment vertical 
component Mdmdz is determined according to the following 
equation. 

Msumz = Floor reaction force moment vertical 
component without correction 

+ Mafdmd + Mdmdz 

Subsequently, a model antiphase arm swing 
stabilization floor reaction force moment is determined 
according to the following equation. 

If Msumz > Upper limit value of a floor reaction 
force moment vertical component permissible range, then 
Model antiphase arm swing stabilization floor 
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reaction force moment = -Mdmdz 

- Floor reaction force moment vertical component 
without correction 

+ Upper limit value of the floor reaction force 
moment vertical component permissible range. 

If Msumz < Lower limit value of a floor reaction 
force moment vertical component permissible range, then 

Model antiphase arm swing stabilization floor 
reaction force moment = -Mdmdz 

- Floor reaction force moment vertical component 
without correction 

+ Lower limit value of the floor reaction force 
moment vertical component permissible range. 

If a lower limit value of a floor reaction force 
moment vertical component permissible range :£ Msumz and 
Msumz ^ Upper limit value of the floor reaction force 
moment vertical component permissible range, then 
Model antiphase arm swing stabilization floor 
reaction force moment 

= Required value Mafdmd of model antiphase arm 
swing angle stabilization floor reaction force moment 

Equation d26c 

Subsequently, the antiphase arm swing angular 
acceleration of a corrected gait is determined according 
to the following equation. 
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Antiphase arm swing angular acceleration of corrected 

gait 

= Original gait antiphase arm swing angular 
5 acceleration paorg 

+ Model antiphase arm swing stabilization floor 
reaction force moment 

/ Equivalent Inertlal moment of arm swing motion AMaz 

10 The floor reaction force moment vertical component of 

the corrected gait Is the sum of the antiphase arm swing 
angular acceleration of the original gait paorg and the 
model antiphase arm swing stabilization floor reaction 
force moment. Therefore, the aforesaid restoring 

15 condition 3 Is satisfied by determining the model 

antiphase arm swing stabilization floor reaction force 
moment according to the above equations. 

After carrying out the processing of S2212 as 
described above, the processing proceeds to S2214 wherein 

20 a model manipulation floor reaction force moment 

horizontal component is determined according to the above 
equation d30. More specifically, the sum of the model 
horizontal body position stabilization floor reaction 
force moment and the model body posture inclination angle 

25 stabilization floor reaction force moment that has been 

obtained in S2208 is determined as the model manipulation 
floor reaction force moment horizontal component. 
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Alternatively, the floor reaction force moment about a 
desired ZMP may be directly calculated on the basis of a 
current time instantaneous value of the motion of a 
finally determined corrected gait, and the calculation 
result may be defined as the model manipulation floor 
reaction force moment. 

Subsequently, the processing proceeds to S2216 
wherein a desired floor reaction force moment horizontal 
component for compliance control is determined according 
to the above equation d27b. More specifically, the sum of 
the compensating total floor reaction force moment 
horizontal component Mdmdxy and the model manipulation 
floor reaction force moment horizontal component obtained 
in S2214 is determined as the desired floor reaction force 
moment horizontal component for compliance control. 

Subsequently, the processing proceeds to S2218 
wherein a desired floor reaction force moment vertical 
component for compliance control is determined according 
to the equation shown in the figure. The floor reaction 
force moment vertical component that balances with the 
corrected gait in the equation shown in the figure 
(dynamically balances with the motion of the corrected 
gait) is the sum of a floor reaction force moment vertical 
without correction and a model antiphase arm swing 
stabilization floor reaction force moment. Alternatively, 
however, the floor reaction force moment vertical 
component about a desired ZMP may be directly calculated 
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on the basis of a current time Instantaneous value of the 
motion of a finally determined corrected gait. 

Thus, the processing of S2114 of Fig. 61 Is finished, 
and then the processing proceeds to S2116. The processing 
5 of this S2116 Is the same as that of S3416 of Fig. 57 In 
the aforesaid second reference example; the current time 
value of a horizontal body position Is determined by the 
second order Integration of a horizontal body acceleration 
and the current value of a body posture Inclination angle 

10 Is determined by the second order Integration of a body 
posture Inclination angle acceleration. 

Subsequently, the processing proceeds to S2118. The 
processing In this S2118 Is the same as that of S3418 of 
Fig. 57 In the aforesaid first embodiment; the current 

15 time value of an antiphase arm swing angle is determined 
by the second order Integration of an antiphase arm swing 
angular acceleration. 

Subsequently, the processing proceeds to S2036 of Fig. 
60 to add a control cycle At to time t, and then returns 

20 to S2014 wherein it waits for a timer interrupt for each 
control cycle. 

Supplementally, to determine a gait instantaneous 
value on the basis of a dynamic model in the third 
reference example, the state amount of the dynamic model 

25 (or the last time or the last but one time gait 

instantaneous values) are also necessary, so that two 
dynamic models, one for generating a corrected gait and 
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the other for generating an original gait are necessary. 
In the third reference example, the dynamic models use the 
dynamic model shown In Fig. 12. 

In the present embodiment, as discussed above, an 
original gait and a corrected gait are generated In 
parallel, and the corrected gait Is corrected to stabilize 
the posture (the Inclination angle and the yaw angle) of 
the actual robot 1. If there Is still an allowance even 
after a floor reaction force moment (a horizontal 
component and a vertical component) required for posture 
restoration by compliance control Is generated, then the 
allowance Is used for convergence to an original gait as 
much as possible. Therefore, In addition to the action 
advantages of the aforesaid second reference example, a 
gait close to an Initially set original gait, that Is, a 
gait approximated to the gait Initially required, can be 
generated. Hence, If a preset travel path Is provided, 
then It will be possible to prevent significant deviation 
from the travel path. Moreover, a priority has been given 
to the convergence of the body posture inclination angle 
of the corrected gait to the body posture inclination 
angle of an original gait (the initially determined gait) 
rather than to the convergence of the horizontal body 
position of the corrected gait to the horizontal body 
position of the original gait (the initially determined 
gait) (the motion of the body translatlonal mode has been 
adjusted as much as possible within the range in which a 
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floor reaction force horizontal component permissible 
range Is satisfied) , thus making It possible to restrain a 
significant change In the body posture Inclination angle. 

5 Referring now to Fig. 63 through Fig. 70, a fourth 

reference example will be explained. In the explanation 
of the fourth reference example, the like constituent 
parts or like functional parts as those In the aforesaid 
first to third reference examples will be assigned like 
10 reference numerals as those In the first to third 

reference examples, and detailed explanation thereof will 
be omitted. 

In the fourth reference example, the functional 
construction of a control unit 60 is the same as that of 

15 the third reference example, that is, the same as that 

shown In Fig. 59 mentioned above. However, In the fourth 
reference example, the algorithm for generating gaits 
executed by a gait generating device 100 is different from 
that of the aforesaid third reference example. And the 

20 processing of units other than the gait generating device 
100 Is identical to that of the aforesaid third reference 
example . 

Fig. 63 is a block diagram showing an outline of the 
processing of the gait generating device 100 in the 
25 present embodiment. Referring to this Fig. 63, an outline 
of the processing of the gait generating device 100 will 
be explained below. Incidentally, the outline of the 
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processing to be explained below In conjunction with Fig. 
63 will apply also to fifth to seventh reference exeunples 
to be discussed hereinafter. In the fourth reference 
example and the fifth to the seventh reference examples to 
be discussed hereinafter, the dynamic model of the 
aforesaid Fig. 12 will be referred to as a "simplified 
model" . 

As Illustrated, the gait generating device 100 Is 
equipped with a gait parameter determiner 100a. The gait 
parameter determiner 100a determines a value of a 
parameter of a desired gait (the parsuneter defining the 
desired gait) or a time series table thereof. This 
corresponds to the processing of S3520 through S3530 of 
the flowchart of Fig. 65 to be discussed hereinafter. 

Although details will be given hereinafter, 
parameters determined by the gait parameter determiner 
100a Includes the parameters that define a desired foot 
position/posture trajectory, a desired arm posture 
trajectory, a reference body posture trajectory, a desired 
ZMP trajectory, a desired floor reaction force vertical 
component trajectory, etc. In addition to a parameter that 
defines a floor reaction force horizontal component 
permissible range, a parameter that defines a ZMP 
permissible range (or a floor reaction force moment 
horizontal component permissible range), and a parameter 
that defines a floor reaction force moment vertical 
component permissible range. In this case, the floor 
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reaction force horizontal component permissible range and 
the floor reaction force moment vertical component 
permissible range to be set In the fourth reference 
example come In two types, one for simplified model gaits 
5 set by the processing of S3526 to be described later and 
the other for correcting a gait to be set In S3530. 
Meanwhile, a ZMP permissible range (or a floor reaction 
force moment horizontal component permissible range) comes 
In only one type for full model correction (for correcting 

10 a gait) set by the processing of S3530. In the fourth 

reference excimple, S3530 sets a parameter for defining the 
ZMP permissible range. This Is equivalent to setting a 
parameter that defines a floor reaction force moment 
horizontal component permissible range. This is because 

15 the value obtained by dividing a floor reaction force 

moment horizontal component by a desired floor reaction 
force vertical component represents the amount of the 
deviation of a ZMP (floor reaction force central point) 
from a desired ZMP, as has been explained In relation to 

20 S3030 of Fig. 56 in the aforesaid second reference example. 
Here, the ZMP permissible range to be set in the 
fourth reference example will be set as shown in Fig. 64. 
The details have been given in PCT/ JP03/00435 , so that 
further explanation will be omitted. 

25 A gait parameter determined by the gait parameter 

determiner 100a is input to a desired Instantaneous value 
generator 100b. Based on the input gait parameter, the 



- 271 - 



desired Instantaneous value generator 100b sequentially 
calculates (generates) the Instantaneous values of desired 
foot position/posture, a desired ZMP, a desired floor 
reaction force vertical component, a desired arm posture, 
5 a desired total center- of -gravity vertical position, a 
desired vertical body position, a floor reaction force 
horizontal component permissible range, a ZMP permissible 
range, a reference body posture angle, and a reference 
antiphase arm swing angle at current time t (Fig. 63 shows 

10 only some of desired instantaneous values). The 

processing of the desired instantaneous value generator 
100b corresponds to the processing of S3 400 through S3 4 12 
of Fig. 57 carried out in the processing of S3532 of the 
flowchart of Fig. 65 to be discussed hereinafter and the 

15 processing of S3534 of Fig. 65. In the fourth reference 

example, of the desired instantaneous values calculated by 
the desired instantaneous value generator 100b, some 
instantaneous values (specifically, the instantaneous 
value of a desired vertical body position) are provisional 

20 values, which will be corrected later. The Instantaneous 
values of the floor reaction force horizontal component 
permissible range and the floor reaction force moment 
vertical component permissible range calculated by the 
desired instantaneous value generator 100b come in the 

25 instantaneous values for simplified model gaits and the 
instantaneous values for correcting gaits. 

Desired Instantaneous values (some are provisional 



- 272 - 



Instantaneous values) calculated (generated) by the 
desired Instantaneous value generator 100b are input to a 
full-model correction unit 100c. Also input to the full- 
model correction unit 100c are the compensating total 
floor reaction force moment horizontal component Mdmdxy 
determined by the aforesaid posture inclination 
stabilization control calculator 112 (refer to Fig. 59) 
and the compensating total floor reaction force moment 
vertical component Mdmdz determined by the aforesaid yaw 
stabilization control calculator 113 (refer to Fig. 59). 
The full-model correction unit 100c is provided with a 
simplified model lOOcl and a full model 100c2 as dynamic 
models. Based on the simplified model lOOcl, the full- 
model correction unit lOOc determines the provisional 
instantaneous values or the like of a desired body 
position/posture and an antiphase arm swing angle from the 
input values, and further corrects the provisional 
instantaneous values or the like of the determined body 
position/posture and the antiphase arm swing angle by 
using the full model 100c2. 

As an alternative construction, the simplified model 
lOOcl may not be included in the full-model correction 
unit 100c2. The full model 100c2 includes either an 
inverse full model (an inverse dynamic full model) or a 
forward full model (a forward dynamic full model), as will 
be discussed hereinafter. 

The full-model correction unit 100c basically 
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executes the processing of B to satisfy the following 
conditions Al through A4 . Specifically, the full-model 
correction unit 100c carries out; 

Al) the value obtained by adding the compensating total 
5 floor reaction force moment horizontal component Mdmdxy 
and the compensating total floor reaction force moment 
vertical component Mdmdz to the floor reaction force 
moment balancing the motion of a corrected gait generated 
by the full-model correction unit 100c agrees with the 

10 floor reaction force moment for compliance control that Is 
output from the full-model correction unit 100c, 
A2) a true ZMP (the ZMP that satisfies the original 
definition corrected by generating a desired floor 
reaction force moment for compliance control about a 

15 desired ZMP) lies In a ZMP permissible range (a 

permissible range that allows a sufficient stability 
allowance to be maintained) , 

A3) a floor reaction force horizontal component lies in 
the floor reaction force horizontal component permissible 

20 range for correcting a gait, and 

A4) a desired floor reaction force moment vertical 
component for compliance control to be generated about a 
desired ZMP lies in a floor reaction force moment vertical 
component permissible range. 

25 B) The body position/posture of a simplified model gait 
determined using the simplified model is corrected, and 
the desired floor reaction force moment for compliance 
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control about the desired ZMP Is output. 

The above condition A2 is equivalent to restricting a 
floor reaction force moment generated about the desired 
ZMP to a floor reaction force moment horizontal component 
5 permissible range that corresponds to a ZMP permissible 
range . 

Here, the aforesaid simplified model lOOcl and the 
aforesaid full model 100c2 will be explained. The 
simplified model lOOcl is a dynamic model with an emphasis 

10 placed on a reduced volume of calculation or the ease of 
behavior analysis rather than dynamic accuracy, and may 
ignore some dynamic elements (e.g., ignore a change in the 
angular momentum about the center of gravity) or may have 
contradiction (lack in preciseness ) . In the fourth 

15 reference example, the dynamic model of Fig. 12 explained 
in the aforesaid first reference example (the dynamic 
model described in conjunction with the above Equations 01 
to 05) is used as the simplified model lOOcl. 

The full model 100c2 means a robot dynamic model that 

20 is different from the simplified model lOOcl. This is 
desirably a robot dyneunic model having a higher 
approximation accuracy than that of the simplified model 
lOOcl. This will be explained in conjunction with the 
illustrated exeunple. As previously described, in the 

25 fourth reference example, the dynamic model shown in the 
above Fig. 12 is used as the simplified model lOOcl; 
therefore, a dynamic model having a higher approximation 
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accuracy than that, such as the robot dynamic model like 
the multi-mass -point model (the model having a mass point 
for each link of the robot 1) shown in, for example. Fig. 
49 mentioned above, is desirably used as a full model 
100c2. In this case, the full model 100c2 may be such 
that an inertial moment is set about a mass point. 

However, the simplified model lOOcl and the full 
model 100c2 do not have to necessarily have different 
model approximation accuracies. The simplified model 
lOOcl and the full model 100c2 may share the same dynamic 
equations and have different floor reaction force 
horizontal component permissible ranges and/or floor 
reaction force moment vertical component permissible 
ranges, that is, they may be different only in the 
permissible range for simplified model gaits and the 
permissible range for gait correction (for full model 
correction). For instance, the floor reaction force 
horizontal component permissible range and the floor 
reaction force moment vertical component permissible range 
for generating gaits by the simplified model lOOcl may be 
merely set to be wide (may even exceed a frictional limit), 
while setting narrow ranges for the floor reaction force 
horizontal component permissible range and the floor 
reaction force moment vertical component permissible range 
applied for correcting gaits using the full model 100c2, 
thereby making it difficult for the robot 1 to slip or 
spin. 
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In the present description, the model used to 
calculate (output) body position/posture and an antiphase 
arm swing angle on the basis of (by entering) desired foot 
position/posture, a desired floor reaction force 
5 (particularly, a desired ZMP and a desired floor reaction 
force vertical component) is called the "forward dynamic 
model." The model used to calculate (output) a floor 
reaction force (especially a desired ZMP or a floor 
reaction force moment (a horizontal component and a 

10 vertical component) and a floor reaction force horizontal 
component) on the basis of (by entering) desired foot 
position/posture, a desired body posture, a desired body 
position and an antiphase arm swing angle is called the 
''inverse dynamic model," An input of the forward dynamic 

15 model includes at least a desired floor reaction force, 
while an input of the Inverse dynamic model Includes at 
least a desired motion. 

The full model 100c2 provided in the full-model 
correction unit 100c is equipped with an inverse dynamic 

20 full model (frequently referred to simply as "Inverse full 
model") or a forward dynamic full model (frequently 
referred to simply as "forward full model"). In general, 
the volume of calculation of a forward dynamic model tends 
to be greater than that of an Inverse dynamic model. 

25 The above is the outline of the processing in the 

gait generating device 100 in the fourth reference example. 
The processing of the gait generating device 100 in 
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the fourth reference example will now be explained In 
detail. The gait generating device 100 in the fourth 
reference example carries out the processing shown in the 
flowchart of Fig. 65 to generate gaits. 
5 First, the same processing as the processing from 

S3010 to S3028 of Fig. 56 explained in the aforesaid 
second reference example is carried out in S3510 to S3528. 
The floor reaction force horizontal component permissible 
range for a current time gait determined in S608 of Fig. 

10 39, which is the subroutine of S3026, and the floor 

reaction force moment vertical component permissible range 
determined in S610 require less strict consideration given 
to the limit of a frictional force than in the case of the 
aforementioned first to third reference examples, and may 

15 be set to ranges that exceed the limit of the frictional 
force. This is because the floor reaction force 
horizontal component and the floor reaction force moment 
vertical component will be eventually restricted by a 
floor reaction force horizontal component permissible 

20 range and a floor reaction force moment vertical component 
permissible range for full model correction by the full 
model correction, which will be discussed hereinafter. 

Subsequently, the processing proceeds to S3530 
wherein the parameters defining the floor reaction force 

25 horizontal component permissible range, the floor reaction 
force moment vertical component permissible range, and the 
ZMP permissible range (floor reaction force central point 
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permissible range) for full model correction (for gait 
correction) are determined. In this case, the floor 
reaction force horizontal component permissible range for 
full model correction is set to have a pattern, as shown 
5 in the aforesaid Fig. 30, on the basis of a floor reaction 
force vertical component trajectory and the above Equation 
12 for the X-axis direction (the longitudinal direction) 
and the Y-axis direction (the lateral direction), 
respectively, as in the case of, for example, the floor 

10 reaction force horizontal component permissible range for 
the aforesaid simplified model gaits. Then, for example, 
the value of ka«|Li of the above Equation 12 is set as the 
parameter that defines the floor reaction force horizontal 
component permissible range for full model correction. 

15 However, the floor reaction force horizontal component 

permissible range is desirably set such that it securely 
falls within the range of a frictional limit by, for 
example, setting the value of coefficient ka of Equation 
12 to be smaller than the floor reaction force horizontal 

20 component permissible range for simplified model gaits. 

The floor reaction force moment vertical component 
permissible range is set in the same manner as that for 
the floor reaction force horizontal component permissible 
range. More specifically, the floor reaction force moment 

25 vertical component permissible range is set to the pattern, 
as shown in the aforesaid Fig. 41, according to the 
aforesaid Equation 1012. 
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The ZMP permissible range Is set In the same manner 
as that for the case explained In conjunction with the 
setting of the floor reaction force moment horizontal 
component permissible range In S3030 of Fig. 56 In the 
5 aforementioned second reference exeunple. The ZMP 

permissible range may be of course converted Into a floor 
reaction force moment horizontal component permissible 
range equivalent thereto by multiplying the ZMP 
permissible range by a desired floor reaction force 

10 vertical component . 

Subsequently, the processing proceeds to S3532 
wherein the Instantaneous value of the current time gait 
(the value at the current time t) Is determined using the 
aforesaid simplified model (the dynamic model shown In Fig. 

15 12). The processing of this S3532 Is Identical to the 
processing of S030 of Fig. 13 in the aforesaid first 
reference example. 

The Instantaneous value of the gait at the current 
time t generated by the processing up to S3532 explained 

20 above will be hereinafter referred to as the simplified 
model gait Instantaneous value. In the fourth reference 
example, the simplified model gait instantaneous value is 
determined using a simplified model (the dyneimlc model 
shown in Fig. 12) such that the floor reaction force 

25 moment horizontal component generated about a desired ZMP 
by the resultant force of the inertial force generated in 
the robot 1 and gravity by a motion thereof is zero (such 
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that a dynamic balance condition related to the desired 
ZMP Is satisfied) . 

In this case, of the simplified model gait 
Instantaneous values, the Instantaneous values of a 
5 horizontal body position and a body posture Inclination 

angle, the Instantaneous value of a vertical body position, 
and an Instantaneous value of an antiphase arm swing angle 
are provisional Instantaneous values and will be corrected 
by full model correction to be discussed later. Further, 

10 of the simplified model gait Instantaneous values In the 
fourth reference example, the Instantaneous value of the 
desired floor reaction force moment horizontal component 
about the desired ZMP Is normally zero, whereas a desired 
floor reaction force moment horizontal component for 

15 compliance control as the desired value of the floor 

reaction force moment horizontal component generated about 
the desired ZMP by the full model correction, which will 
be discussed later. Is generated. 

Subsequently, the processing proceeds to S3534 

20 wherein the Instantaneous values (the values at the 

current time t) of the floor reaction force horizontal 
component permissible range, the floor reaction force 
moment vertical component permissible range, and the ZMP 
permissible range for gait correction are determined on 

25 the basis of the parameters (which have been set in S3530) 
that define the floor reaction force horizontal component 
permissible range, the floor reaction force moment 
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vertical component permissible range, and the ZMP 
permissible range for gait correction (for full model 
correction) . 

Subsequently, the processing proceeds to S3536 
5 wherein the full model is used to generate a corrected 
gait (to correct the gait) so as to determine the 
instantaneous value of a final desired gait. More 
specifically, as explained with reference to the aforesaid 
Fig. 63, the calculation (determination) of corrected 

10 desired body position/posture, a corrected desired 

antiphase arm swing angle, and a desired floor reaction 
force moment (a horizontal component and a vertical 
component) for compliance control as a desired floor 
reaction force moment (a horizontal component and a 

15 vertical component) about a desired ZMP is mainly 
performed. 

Subsequently, the processing proceeds to S3538 to 
increment the time t by At, and returns to S3514 again to 
repeat the processing from S3514 to S3538. 

20 The processing of S3536 described above, which 

constitutes a characteristic of the fourth reference 
example, will be explained in detail below. The gait 
correcting technique of a device in accordance with the 
fourth reference example is a full-model feedforward 

25 correction type. Furthermore, the gait correction 

technique uses an inverse dynamic full model (inverse full 
model), and it is a technique that does not correct an 
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Input of a simplified model gait, and It Is a technique 
that uses a perturbation model. 

Fig. 66 is a functional block diagram explaining the 
operation of the gait generating device 100 according to 
5 the fourth reference example, specifically, the technique 

for correcting a gait in S3536 of the flowchart of Fig. 65. 
A simplified model 200 shown in Fig. 66 represents not 
only a dynamic model but the processing of S3510 to S3532 
discussed above, namely, the processing of calculating 
10 (determining) the instantaneous value of a simplified 

model gait. In Fig. 66, therefore, the portion beyond the 
simplified model 200 corresponds to the processing of 
S3536. 

The processing for determining the instantaneous 
15 values of the floor reaction force horizontal component 
permissible reinge and the ZMP permissible range for gait 
correction (for full model correction) is shown using a 
reference mark S3534 of the flowchart of Fig. 65. 

The actual processing is implemented by a single 
20 computer, so that it is Implemented in order toward a 
downstream side (toward a gait output side) from an 
upstream side in the block diagram after the block diagram 
is broken up. However, a feedback amount returned to the 
upstream side uses a value (a state amount) calculated in 
25 the last control cycle (time t-At with respect to the 

current time t) . Hereinafter, the value calculated in the 
last time control cycle (time t-At) will be abbreviated as 
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a last time value. 

Each time the processing of S3536 is carried out, the 
calculation for one control cycle in the block diagram is 
performed . 

In S3536, first, the instantaneous values of 
variables representing a motion (this is called a motion 
variable), such as the desired body posture angle 
(hereinafter referred to as "the simplified model body 
posture angle." Further, an inclination angle component 
thereof will be referred to as "the simplified model body 
posture inclination angle"), the desired horizontal body 
position (hereinafter referred to as the simplified model 
horizontal body position), the desired center-of -gravity 
position, the desired foot position/posture, and the 
desired arm posture (including the desired antiphase arm 
swing angle) of the simplified model gait obtained as 
described above, and the instantaneous value of a desired 
ZMP are input to the aforesaid inverse dynamic full model 
(inverse full model) 201. The floor reaction force 
horizontal component balancing the motion represented by 
the input motion variables (in other words, a full model 
is generated by the motion) and the floor reaction force 
moment about the desired ZMP (a horizontal component and a 
vertical component) are calculated by the calculation 
processing of the inverse full model 201. In the fourth 
reference example, the floor reaction force moment 
horizontal component about the desired ZMP in the 
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simplified model gait is zero, so that the floor reaction 
force moment horizontal component about the desired ZMP 
calculated by the inverse full model 201 has a meaning as 
an error of a simplified model gait. Incidentally, the 
5 floor reaction force horizontal component, the floor 

reaction force moment horizontal component, and the floor 
reaction force moment vertical component determined by the 
inverse full model 201 are called "the full-model floor 
reaction force horizontal component," "the full-model 

10 floor reaction force moment horizontal component," and 
"the full-model floor reaction force moment vertical 
component," respectively. Hereinafter, the full-model 
floor reaction force horizontal component will be 
frequently abbreviated as Ffull, the full-model floor 

15 reaction force moment horizontal component will be 

frequently abbreviated as Mfullxy, and the full-model 
floor reaction force moment vertical component will be 
frequently abbreviated as Mf ullz . 

Furthermore, the aforesaid inverse full model 201 

20 calculates the vertical body position that satisfies a 

desired cent er-of -gravity position. Although not shown, 
the inverse full model 201 also calculates the center-of- 
gravity horizontal position. 

Supplementally, a desired total center-of -gravity 

25 vertical position is input to the full model, and a 
desired floor reaction force vertical component is 
determined from the second order differential value of the 
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desired total center -of -gravity vertical position. Hence, 
there Is no particular need to Input a desired floor 
reaction force vertical component to the full model. 
Mainly for a reason of achieving a reduction of 
calculation, a desired floor reaction force vertical 
component may be input to the full model even If It Is 
redundant . 

A perturbation model used for gait correction will 
now be explained. 

The perturbation model is composed of a horizontal 
body position correcting perturbation model 202, a body 
posture inclination angle correcting perturbation model 
203, and an antiphase arm swing angle correcting 
perturbation model 231. The perturbation model may be a 
single model shown in Fig. 12 rather than being composed 
of such three separate models. The body posture 
inclination angle correcting perturbation model 203 is 
abbreviated as the body posture angle correcting 
perturbation model 203 in the figure. 

The horizontal body position correcting perturbation 
model 202 represents the relationship between the 
perturbation of a floor reaction force and the 
perturbation of a horizontal body position in the 
aforesaid body translatlonal mode. 

The horizontal body position correcting perturbation 
model 202 receives a correction amount of a desired floor 
reaction force moment and calculates a correction amount 
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Of a desired horizontal body position that dynamically 
balances with the received correction amount of the 
desired floor reaction force moment. This Input (the 
correction amount of the desired floor reaction force 
moment) Is called a perturbation model moment for 
correcting horizontal body position Mp. An output (the 
correction amount of a desired horizontal body position) 
of the horizontal body position correcting perturbation 
model 202 Is called a correcting perturbation model 
horizontal body position Xc. The floor reaction force 
horizontal component generated by the horizontal body 
position correcting perturbation model 202 Is called a 
perturbation model floor reaction force horizontal 
component for correcting horizontal body position Fp. 

The horizontal body position correcting perturbation 
model 202 Is represented by an Inverted pendulum composed 
of a support point, an Inverted pendulum mass point (body 
mass point), and an extensible support rod connecting them, 
as shown in Fig. 67 • The position of the support point is 
set so that the horizontal position of the support point 
agrees with the horizontal position of the origin of the 
current time's gait supporting leg coordinate system 
described above, and the vertical position of the support 
point agrees with the vertical position of a desired ZMP. 
A mass mb of the Inverted pendulum mass point is identical 
to the mass of the body mass point of the aforesaid 
simplified model (the model with 3 mass points + 
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flywheels) shown in Fig. 12. A vertical position Zc of 
the inverted pendulum mass point is to be identical to a 
vertical position Zb of the body mass point position of 
the simplified model shown in Fig. 12, which corresponds 
to a simplified gait. 

The horizontal body position correcting perturbation 
model 202 shows the relationship between a perturbation 
AMy of a floor reaction force moment and a perturbation 
AXb of a body mass point horizontal position in the 
aforesaid simplified model. 

Hence, assuming that parameters other than My, Xb, 
and Zb take constants, if the relationship between the 
perturbation AMy of a floor reaction force moment and the 
perturbation AXb of a body mass point horizontal position 
is determined from the above Equation 03y, then the 
following equation will be obtained. 

AMy = -mb*AXb*{g+d2Zb/dt2)+mb*(Zb-Z2mp)*d2AXb/dt2 

... Equation al2 

Similarly, assuming that parameters other than Fx and 
Xb take constants, if the relationship between the 
perturbation AFx of a floor reaction force horizontal 
component and the perturbation AXb of a body mass point 
horizontal position is determined from the above Ecpiation 
02x, then the following equation will be obtained. 
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AFx = mb * d2AXb/dt2 ... Equation al3 

A body translational mode floor reaction force ratio 
h, which is the ratio of AMp to AFp generated by a 
horizontal body acceleration, is the ratio of the term 
generated by the horizontal body acceleration (that is, 
the second term) of the right side of Equation al2 to 
Equation al3, so that the following equation will be 
obtained. 

h = (Zb - Zzmp) ... Equation al4 

In other words, the body translational mode floor 
reaction force ratio h corresponds to the height from the 
support point of the body mass point (the inverted 
pendulum mass point) of the simplified model. 

Accordingly, the following equation is derived from 
Equation al2 and Equation al4* 

AMy=-mb*AXb*(g+d2Zb/dt2)+mb*h*d2AXb/dt2 ... Equation al5 

Meanwhile, the floor reaction force vertical 
component that balances with the translational force 
vertical component of the resultant force of the gravity 
and the inertial force acting on the body mass point (the 
inverted pendulum mass point) is referred to as a body 
floor reaction force vertical component Fbz. Specifically, 
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the body floor reaction force vertical component Fbz Is 
defined by the following equation. 

Fbz = mb * (g+d2Zb/dt2) ... Equation al6 

And, from the Equation al6 and the aforesaid Equation 
01, the body floor reaction force vertical component Fbz 
Is determined from the following equation. 

Fbz=Fz-msup* ( g+d2Zsup/dt2 ) -mswg* { g+d2Zswg/dt2 ) 

... Equation al7 

In other words, the body floor reaction force 
vertical component Is equal to the sum of the floor 
reaction force vertical component Fz and the translatlonal 
force vertical component of the resultant force of the 
gravity and the Inertlal force acting on both leg mass 
points of the aforesaid simplified model (the model with 3 
mass points + flywheels) shown In Fig. 12. 

Substituting Equation al6 Into Equation al5 provides 
the following equation. 

AMy = -Fbz*AXb+mb*h*d2AXb/dt2 ... Equation al8 

Associating AMy of Equation al8 with the perturbation 
model moment for correcting horizontal body position Mp, 
and associating AXb with the correcting perturbation model 
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horizontal body position Xc (substituting the perturbation 
model moment for correcting horizontal body position Mp 
Into AMy of Equation al8, and substituting the correcting 
perturbation model horizontal body position Xc into AXb) 
provide the following equation. 

Mp = -Fbz*Xc+mb*h*d2Xc/dt2 ... Equation al9 

In other words, the horizontal body position 
correcting perturbation model 202 is expressed by Equation 
al9 by using the body translatlonal mode floor reaction 
force ratio h determined according to Equation al4 and the 
body floor reaction force vertical component Fbz 
determined according to Equation al7. 

Further, associating AFx of Equation al3 with the 
perturbation model floor reaction force horizontal 
component for correcting horizontal body position Fp 
provides the following equation. 

Fp = mb * d2Xc/dt2 ... Equation a20 

In other words, the horizontal body position 
correcting perturbation model 202 is described by Equation 
al4. Equation al7. Equation al9, and Equation a20. 

Supplementally, it is regarded here that the 
perturbation of a body mass point position and the 
perturbation of a body position (the position of a body 
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representative point) agree; strictly speaking, however, 
they do not always agree. Accordingly, to determine the 
relationship among Mp, Fp, and Xc, a model that expresses 
a geometric relationship between the horizontal position 
of a body mass point and a body position is further 
necessary. 

Meanwhile, a body posture inclination angle 
correcting perturbation model 203 represents a 
relationship between the perturbation of a floor reaction 
force and a body posture inclination angle in the 
aforesaid body inclination mode. 

The body posture inclination angle correcting 
perturbation model 203 receives a correction amount of a 
floor reaction force moment horizontal component and 
calculates a correction amount of a desired body posture 
inclination angle that dynamically balances with the 
received correction amount of the floor reaction force 
moment horizontal component. This input (the correction 
amount of the floor reaction force moment) is called a 
perturbation model moment for correcting body posture 
inclination angle Mr (abbreviated to a perturbation model 
for correcting body posture angle Mr in some cases). An 
output (the correction amount of a desired body posture 
inclination angle) of the body posture inclination angle 
correcting perturbation model 203 is called a correcting 
perturbation model body posture inclination angle 0c. The 
floor reaction force horizontal component generated by the 
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body posture Inclination angle correcting perturbation 
model 203 Is called a perturbation model floor reaction 
force horizontal component for correcting horizontal body 
position Fr. Fr is zero as mentioned above. This means 
5 that the following equation always holds. 

Fr = 0 ... Equation a21 

The body posture inclination angle correcting 

10 perturbation model 203 is expressed by a flywheel, as 

shown in Fig. 68. Supplementally, Fig. 68 shows only the 
flywheel that rotates about the Y-axis; however, the body 
posture inclination angle correcting perturbation model 
203 actually requires a flywheel that rotates about the X- 

15 axis in addition to the flywheel rotating about the Y-axis. 
The inertia of those flywheels are the same as the 
flywheels FHx and FHy of the aforesaid simplified model 
(the model with 3 mass points + flywheels) shown in Fig. 
12. The rotational angle of a flywheel of the body 

20 posture inclination angle correcting perturbation model 

203 corresponds to the correcting perturbation model body 
posture inclination angle Oc, and the floor reaction force 
moment horizontal component generated by the flywheel 
corresponds to the perturbation model moment Mr for 

25 correcting body posture inclination angle. In the 
following explanation, for the convenience of 
understanding, the explanation will center around the 
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flywheel that rotates about the Y-axls. The same applies 
to the flywheel that rotates about the X-axls. 

The body posture inclination angle correcting 
perturbation model 203 (more specifically^ the model 
related to a sagittal plane) expresses a relationship 
between the floor reaction force moment perturbation AMy 
and the body posture inclination angle perturbation A0by 
in the aforesaid Equation 03y of the dynamic equation of 
the aforesaid simplified model (the model with 3 mass 
points + flywheels). 

Accordingly, if parameters other than My and 9by are 
assumed to be constants, and if the relationship between 
the floor reaction force moment horizontal component 
perturbation AMy and the body posture inclination angle 
perturbation ASby is determined according to Equation 03y, 
then the following equation will be obtained. 

AMy = J * d2Aeby/dt2 ... Equation a22 

Associating AMy of Equation a22 with the perturbation 
model moment for correcting body posture inclination angle 
Mr, and associating ASby with the correcting perturbation 
model body posture inclination angle 0c provide the 
following equation. 

Mr = J * d2Aec/dt2 ... Equation a23 
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In other words, the body posture Inclination angle 
correcting perturbation model 203 Is represented by 
equation a23. The perturbation model floor reaction force 
horizontal component for correcting horizontal body 
position Fr Is determined according to Equation a21 as 
described above (Fr = 0). In the above description, the 
dynamics of the body posture Inclination angle correcting 
perturbation model 203 has been explained on the sagittal 
plane. The dynamics on a lateral plane Is represented by 
the same type of equation as Equation a23. 

An antiphase arm swing angle correcting perturbation 
model 231 shows the relationship between the perturbation 
of a floor reaction force and the perturbation of an 
antiphase arm swing angle In the antiphase arm swing mode* 

The antiphase arm swing angle correcting perturbation 
model 231 receives a correction amount of a floor reaction 
force moment vertical component and calculates a 
correction amount of a desired antiphase arm swing angle 
that dynamically balances with the received correction 
amount of the floor reaction force moment vertical 
component. This input (the correction amount of the floor 
reaction force moment vertical component) is called a 
perturbation model moment for correcting antiphase arm 
swing angle Ma. An output (the correction amount of a 
desired antiphase arm swing angle) of the antiphase arm 
swing angle correcting perturbation model 203 is called a 
correcting perturbation model antiphase arm swing angle 
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6ca. The floor reaction force horizontal component 
generated by the perturbation model for correcting 
antiphase arm swing angle is called a perturbation model 
floor reaction force horizontal component for correcting 
5 antiphase arm swing angle Fa. Fa is zero as described 
above. This means that the following equation always 
holds . 

Fa = 0 ... Equation a21c 

10 

The antiphase arm swing angle correcting perturbation 
model 231 is expressed by a flywheel, as shown in Fig. 69. 
The inertia of the flywheel is the seime as the flywheel 
FHaz of the aforesaid simplified model (the model with 3 

15 mass points + flywheels) shown in Fig. 12. The rotational 
angle of the flywheel of the antiphase arm swing angle 
correcting perturbation model 231 corresponds to the 
correcting perturbation model antiphase arm swing angle 
Oca, and the floor reaction force moment vertical 

20 component generated by the flywheel corresponds to the 
perturbation model moment for correcting antiphase arm 
swing angle Ma. 

The antiphase arm swing angle correcting perturbation 
model 231 expresses a relationship between the floor 

25 reaction force moment perturbation AMz and the antiphase 
arm swing angle perturbation ASaz in the aforesaid 
Equation 03z of the dynamic equation of the aforesaid 
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simplified model (the model with 3 mass points + 
flywheels ) . 

Accordingly, If parameters other than Mz and Saz are 
assumed to be constants, and If the relationship between 
5 the floor reaction force moment perturbation AMz and the 
antiphase arm swing angle perturbation A0az is determined 
according to Equation 03z, then the following equation 
will be obtained. 

10 AMz = Jaz * d2A0az/dt2 Equation a22c 

Associating AMz of Equation a22c with the 
perturbation model moment for correcting antiphase arm 
swing angle Ma, and associating A6az with the correcting 
15 perturbation model antiphase arm swing angle Sea provide 
the following equation. 

Ma = Jaz * d2Aeca/dt2 Equation a23c 

20 In other words, the antiphase arm swing angle 

correcting perturbation model 231 Is represented by 
equation a23c. The perturbation model floor reaction 
force horizontal component for correcting antiphase arm 
swing angle Fr Is determined according to Equation a21c as 

25 described above (Fa = 0). 

As It will be discussed later. In S3536, a corrected 



gait (to be more specific, a desired Instantaneous value 
with some Instantaneous values of a simplified model gait 
corrected) are eventually generated (output). A desired 
body posture Inclination angle of the corrected gait 
(hereinafter referred to as the corrected desired body 
posture Inclination angle) is obtained by adding the 
aforesaid correcting perturbation model body posture 
Inclination angle Qc (the value determined In the control 
cycle at the current time t) to the Instantaneous value of 
the aforesaid determined simplified model body posture 
inclination angle (the instantaneous value of the desired 
body posture inclination angle at the current time t of 
the current time gait determined in S3532) by a calculator 
204. The desired horizontal body position of the 
corrected gait (hereinafter referred to as "the corrected 
desired horizontal body position") is obtained by adding 
the correcting perturbation model horizontal body position 
Xc (the value determined in the control cycle at the 
current time t) to the instantaneous value of the 
aforesaid determined simplified model horizontal body 
position (the instantaneous value of the desired 
horizontal body position at the current time t of the 
current time gait determined in S3532) by a calculator 205. 
Further, a desired antiphase arm swing angle of a 
corrected gait (hereinafter referred to as "the corrected 
desired antiphase arm swing angle") is obtained by adding 
the correcting perturbation model antiphase arm swing 
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angle Bca (the value determined in the control cycle at 
the current time t) to the instantaneous value of the 
aforesaid determined simplified model antiphase arm swing 
angle (the instantaneous value of the desired antiphase 
5 arm swing angle at the current time t of the current time 
gait determined in S3532) by a calculator 232. 

The desired floor reaction force of the corrected 
gait is also corrected. Specifically, the floor reaction 
force moment horizontal component about the desired ZMP is 

10 no longer zero, and the desired floor reaction force 
moment horizontal component for compliance control is 
output as a desired value. Further, the desired floor 
reaction force horizontal component is also corrected to a 
corrected desired floor reaction force horizontal 

15 component and output. In addition, the desired floor 

reaction force moment vertical component is corrected to a 
corrected desired floor reaction force moment vertical 
component and output. 

As described above, the motion of the corrected gait 

20 is the motion obtained by adding (combining) the motions 
of perturbation models (to be more specific, the motions 
of the horizontal body position correcting perturbation 
model 202 and the body posture inclination angle 
correcting perturbation model 203 and the motion of the 

25 antiphase arm swing angle correcting perturbation model 
231) to the motion of a simplified model gait. 

In general, the floor reaction force generated by a 



motion obtained by adding a certain perturbation motion to 
a certain reference motion Is approximated by the sum of 
the floor reaction force generated by the reference motion 
(the floor reaction force counterbalancing the gravity and 
the Inertlal force generated by the motion) and the 
perturbatlonal portion of the floor reaction force 
generated by the perturbation motion. 

Considering that the floor reaction force horizontal 
component generated by the body Inclination mode, the 
floor reaction force moment vertical component generated 
by the body Inclination mode, the floor reaction force 
horizontal component generated by the antiphase arm swing 
mode, and the floor reaction force moment horizontal 
component generated by the antiphase arm swing mode are 
all zero, the three equations given below must be 
satisfied for the result, which Is obtained by adding the 
compensating total floor reaction force moment horizontal 
component Mdmdxy and the compensating total floor reaction 
force moment vertical component Mdmdz to the floor 
reaction force moment that balances with the motion of a 
corrected gait on the Inverse full model 201, to agree 
with a corrected desired floor reaction force moment (to 
satisfy the condition of Al described above). 

Full-model floor reaction force moment horizontal 
component Mfullxy 

+ Perturbation model moment for correcting horizontal body 
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position Mp 

+ Perturbation model moment for correcting body posture 
Inclination angle Mr 

+ Compensating total floor reaction force moment 
horizontal component Mdmdxy 

= Corrected desired floor reaction force moment horizontal 
component 

... Equation h5 

Full-model floor reaction force horizontal component 
Ffull 

+ Perturbation model floor reaction force horizontal 
component for correcting horizontal body position Fp 
= Corrected desired floor reaction force horizontal 
component 

... Equation h6 

Full -model floor reaction force moment vertical 
component Mfullz 

+ Perturbation model moment vertical component for 
correcting horizontal body position Mpz 
+ Perturbation model moment vertical component for 
correcting antiphase arm swing angle Maz 

+ Compensating total floor reaction force moment vertical 
component Mdmdz 

= Corrected desired floor reaction force moment vertical 
component 
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... Equation hl006 
where the perturbation model moment vertical 
component for correcting horizontal body position Mpz 
denotes the floor reaction force moment vertical component 
generated on the inverse full model 201 by a motion of the 
perturbation model for correcting horizontal body position 
The moments of Equation h5 and Equation hl006 are the 
moments about an original (simplified model's) desired ZMP 

The true ZMP of a corrected gait is changed to a 
point deviated from the desired ZMP (ideal desired ZMP) of 
a simplified model gait by the value obtained by dividing 
a corrected desired floor reaction force moment by a 
desired floor reaction force vertical component. 

True ZMP of corrected gait « Desired ZMP 

+ Corrected desired floor reaction force moment / 
Desired floor reaction force vertical component 

... Equation h7 

To calculate the component in the X direction 
(longitudinal direction) of the true ZMP of a corrected 
gait, the component about the Y-axis (lateral axis) of a 
corrected desired floor reaction force moment is used. 
Further, to calculate the component in the Y direction of 
the true ZMP of a corrected gait, the component about the 
X-axis (longitudinal axis) of a corrected desired floor 
reaction force moment is used. However, when calculating 
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the component in the Y direction of the true ZMP of a 
corrected gait, of the right side of Equation h7 must 

be changed to " - " . 

Supplementally, a corrected desired floor reaction 
force moment vertical component about the true ZMP of a 
corrected gait may be calculated, as an alternative. 

The corrected desired floor reaction force moment 
vertical component about the true ZMP of a corrected gait 
will be the outcome obtained by adding the outer product 
of the difference between the true ZMP of a corrected gait 
and a desired ZMP and the corrected desired floor reaction 
force horizontal component determined according to 
Equation h6 to the moment about an original desired ZMP* 

The true ZMP of the corrected gait determined 
according to Equation h7 must fall within a ZMP 
permissible range. This is called a ZMP restriction 
condition . 

The corrected desired floor reaction force horizontal 
component must fall within a floor reaction force 
horizontal component permissible range for correcting gait 
(for full-model correction). This is called a floor 
reaction force horizontal component restriction condition. 

The corrected desired floor reaction force moment 
vertical component must fall within a floor reaction force 
moment vertical component permissible range for correcting 
gait (for full-model correction). This is called a floor 
reaction force moment vertical component restriction 
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condition. 

As described above, a corrected gait must satisfy 
Equation h5. Equation h6. Equation hl006, the ZMP 
restriction condition (the condition of a range in which 
5 the true ZMP of the corrected gait obtained from Equation 
h7 exists), the floor reaction force horizontal component 
restriction condition, and the floor reaction force moment 
vertical component restriction condition. 

However, merely satisfying these equations and 

10 conditions would cause divergence of the aforesaid 

correcting perturbation model body position, the aforesaid 
correcting perturbation model body posture inclination 
angle, and the aforesaid correcting perturbation model 
antiphase arm swing angle. 

15 Therefore, on the basis of the state amounts of the 

aforesaid horizontal body position correcting perturbation 
model 202, the aforesaid body posture inclination angle 
correcting perturbation model 203, and the aforesaid 
antiphase arm swing angle correcting perturbation model 

20 231 (to be more specific, correcting perturbation model's 
horizontal body posit ion/ velocity , correcting perturbation 
model's body posture inclination angle/angular velocity, 
and correcting perturbation model's antiphase arm swing 
angle/angular velocity, etc.), the stabilization control 

25 of the correcting perturbation models 202, 203, and 231 is 
conducted so as to converge (stabilize) these state 
amounts to predetermined states. 
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First, the stabilization control of the horizontal 
body position correcting perturbation model 202 will be 
explained In detail. 

The control law for converging (stabilizing) the 
5 horizontal body position correcting perturbation model 202 
to a desired steady position Is referred to as a 
perturbation model control law 206 for correcting 
horizontal body position, and the feedback amount 
(manipulated variable) determined by this control law Is 

10 referred to as a required value Mpfdmd of perturbation 

model stabilization moment for correcting horizontal body 
position. The term "required value" has been added 
because restriction Is added to the value determined 
according to the above control law to correct It such that 

15 the true ZMP exits In the aforesaid ZMP permissible range 
and the floor reaction force horizontal component falls 
within a floor reaction force horizontal component 
permissible range, as It will be discussed hereinafter. 
The moment corrected by adding restriction thereto is 

20 referred to as the horizontal body position correcting 
perturbation model stabilization moment Mpf . 

Specifically, the perturbation model control law 206 
for correcting horizontal body position uses Equation hlO. 
However, a desired steady position is given by Equation h8. 

25 Further, mtotal denotes the total weight of the aforesaid 
robot, mb denotes the mass of the aforesaid body mass 
point (the mass of the inverted pendulum), and XGf denotes 
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the center- of -gravity horizontal position calculated using 
a full model on the basis of an instantaneous posture of a 
simplified model gait, that Is, the center-of -gravity 
horizontal position calculated by the aforesaid Inverse 
5 full model. Further, Kpp and Kpv denote the gains of 
feedback control. 

Desired steady position = -mtotal/mb*(XGf -XGs ) 

... Equation h8 

10 

Required value Mpfdmd of perturbation model stabilization 
moment for correcting horizontal body position 
= Kpp* (Correcting perturbation model horizontal body 
position Xc - Desired steady position) 
15 + Kpv * Correcting perturbation model horizontal body 
velocity dXc/dt 

- Correcting perturbation model horizontal body position 
Xc * Body floor reaction force vertical component Fbz 

... Equation hlO 

20 

To determine the component about the X-axls 
(longitudinal axis) of the required value Mpfdmd of 
perturbation model stabilization moment for correcting 
horizontal body position, a correcting perturbation model 
25 horizontal body position/velocity and a desired steady 

position use a component in the Y-axis direction (lateral 
direction) . 
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To determine the component about the Y-axls (lateral 
axis) of the required value Mpfdmd of perturbation model 
stabilization moment for correcting horizontal body 
position, a correcting perturbation model horizontal body- 
position velocity and a desired steady position use a 
component In the X-axls direction (longitudinal direction), 
and in the third term of the right side is replaced by 

" + -. 

The details have been described in PCT/ JP03/00435 
previously proposed by the present applicant, so that 
further explanation will be omitted. 

The stabilization control of the body posture 
inclination angle correcting perturbation model 203 will 
be explained in detail. 

According to the state of the body posture 
Inclination angle correcting perturbation model 203, a 
feedback amount (manipulated variable) is determined 
according to a feedback control law, such as the PI 
control, so that a corrected desired body posture 
inclination angle, that is, the inclination angle obtained 
by adding a correcting perturbation model body posture 
Inclination angle to a desired body posture inclination 
angle based on a simplified model, stabilizes to or 
follows a reference body posture inclination angle 
(determined in S3404 of Fig. 57) output by the desired 
instantaneous value generator 100b or a desired body 
posture inclination angle (obtained in S3414 of Fig. 57) 
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based on a simplified model, and the determined feedback 
amount Is additionally input to the body posture 
inclination angle correcting perturbation model 203. 

This control law is referred to as a body posture 
inclination angle correcting perturbation model control 
law 207 (abbreviated as the body posture angle correcting 
perturbation model control law 207 in some cases), and the 
feedback amount (manipulated variable) is referred to as a 
required value Mrfdmd of perturbation model stabilization 
moment for correcting body posture inclination angle. The 
term "required value" has been added for the same reason 
as that for the required value Mpfdmd of perturbation 
model stabilization moment for correcting horizontal body 
position. The moment corrected by adding restriction 
thereto is referred to as perturbation model stabilization 
moment Mrf for correcting body posture inclination angle. 

Specifically, the body posture inclination angle 
correcting perturbation model control law 207 for 
determining the required value Mrfdmd of perturbation 
model stabilization moment for correcting body posture 
inclination angle is implemented according to the equation 
given below. 

Required value Mrfdmd of perturbation model stabilization 
moment for correcting body posture inclination angle 
= Krp * (Correcting perturbation model body posture 
inclination angle 6c 
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- (Reference body posture inclination angle - Desired 
body posture inclination angle based on simplified model)) 
+ Krv * Correcting perturbation model body posture 
inclination angular velocity dBc/dt 

... Equation hll 

where Krp and Krv denote feedback control gains. 

In Equation hll, (Reference body posture inclination 
angle - Desired body posture inclination angle based on 
simplified model) may be replaced by zero. 

The processing in S3 536 will be explained by 
referring back to the functional block diagram of Fig. 66. 
As described above, the required value Mpfdmd of 
perturbation model stabilization moment for correcting 
horizontal body position is determined according to the 
perturbation model control law 206 for correcting 
horizontal body position (Equation hlO). Further, the 
required value Mrfdmd of perturbation model stabilization 
moment for correcting body posture inclination angle is 
determined according to the body posture inclination angle 
correcting perturbation model control law 207 (Equation 
hll) . 

Subsequently, an estimated (calculated) value FO of 
floor reaction force of the perturbation model for 
correcting body position when it is assumed that the 
horizontal body position correcting perturbation model 
stabilization moment Mpf is zero is determined by a FO 



- 309 - 



calculator 208. As it will be discussed hereinafter, the 
full-model floor reaction force moment horizontal 
component Mfullxy to which the horizontal body position 
correcting perturbation model stabilization moment Mpf has 
been added is supplied to the horizontal body position 
correcting perturbation model 202. Hence, FO is the floor 
reaction force generated by the horizontal body position 
correcting perturbation model 202 if only the full-model 
floor reaction force moment horizontal component Mfullxy 
with a reversed sign is supplied to the horizontal body 
position correcting perturbation model 202. 

Specifically, FO is determined according to the 
equation given below. 

FO = mb * d2Xc/dt2 - 1/h * Mpf ... Equation hl2 

The first texm of the right side denotes a floor 
reaction force horizontal component of the horizontal body 
position correcting perturbation model 202 of the last 
time (time t - At) . 

The second term of the right side denotes the floor 
reaction force horizontal component directly generated in 
(i.e., a direct term of) the horizontal body position 
correcting perturbation model 202 by the horizontal body 
position correcting perturbation model stabilization 
moment Mpf of the last time. 

More specifically, the estimated value of the floor 
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reaction force FO of a body position correcting 
perturbation model when It Is assumed that Mpf is zero is 
determined by subtracting the value, which is obtained by 
dividing the horizontal body position correcting 
5 perturbation model stabilization moment Mpf of the last 
time by the body translational mode floor reaction force 
ratio h, from the value obtained by multiplying the body 
mass point horizontal acceleration of the last time of the 
horizontal body position correcting perturbation model 202 

10 by the mass mb of the body mass point. 

Subsequently, if it is assumed that the horizontal 
body position correcting perturbation model stabilization 
moment Mpf is matched with the required value Mpf dmd of 
horizontal body position correcting perturbation model 

15 stabilization moment, the body posture inclination angle 
correcting perturbation model stabilization moment Mrf is 
matched with the required value Mrfdmd of body posture 
inclination angle correcting perturbation model 
stabilization moment, a desired floor reaction force 

20 moment for compliance control as a desired floor reaction 
force moment horizontal component about a desired ZMP is 
matched with the total siam of the compensating total floor 
reaction force moment horizontal component Mdmdxy, Mpf, 
and Mrf, while Ignoring the aforesaid restriction (the 

25 floor reaction force horizontal component restrictive 
condition and the ZMP restrictive condition), then the 
floor reaction force moment horizontal component Mln 
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generated about the desired ZMP is determined by a Mln 
calculator 209. This floor reaction force moment 
horizontal component is referred to as a corrected desired 
floor reaction force moment horizontal component without 
5 restriction Mln. The corrected desired floor reaction 

force moment horizontal component without restriction Mln 
is determined according to the following equation. 

Mln = Mpfdmd + Mrfdmd + Mdmdxy ... Equation hi 3 

10 

This means that the corrected desired floor reaction 
force moment horizontal component without restriction Mln 
is obtained by adding the required value Mpfdmd of 
horizontal body position correcting perturbation model 

15 stabilization moment, the required value Mrfdmd of body 
posture inclination angle correcting perturbation model 
stabilization moment, and the compensating total floor 
reaction force moment horizontal component Mdmdxy. 

Subsequently, if it is assumed that the horizontal 

20 body position correcting perturbation model stabilization 
moment Mpf is matched with the required value Mpfdmd of 
horizontal body position correcting perturbation model 
stabilization moment, the body posture inclination angle 
correcting perturbation model stabilization moment Mrf is 

25 matched with the required value Mrfdmd of body posture 
inclination angle correcting perturbation model 
stabilization moment, and a desired floor reaction force 
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moment for compliance control Is matched with the total 
sum of the compensating total floor reaction force moment 
horizontal component Mdmdxy, Mpf , and Mrf ^ while ignoring 
the aforesaid restriction (the floor reaction force 
horizontal component restrictive condition and the ZMP 
restrictive condition), then the floor reaction force 
horizontal component Fin to be generated is determined by 
a Fin calculator 210. This floor reaction force 
horizontal component is referred to as a corrected desired 
floor reaction force horizontal component without 
restriction Fin. 

The corrected desired floor reaction force horizontal 
component is obtained by the above Equation h6. As 
described above, no floor reaction force horizontal 
component is generated in the body posture inclination 
angle correcting perturbation model 203 by a behavior of 
the body posture inclination angle correcting perturbation 
model 203, meaning that Fr is zero. Accordingly, the 
corrected desired floor reaction force horizontal 
component without restriction Fin is obtained by adding 
the floor reaction force horizontal component, which is 
increased by changing the horizontal body position 
correcting perturbation model stabilization moment Mpf 
from zero to the required value Mpfdmd of horizontal body 
position correcting perturbation model stabilization 
moment, to the corrected desired floor reaction force 
horizontal component in a case where it is assumed that 
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the horizontal body position correcting perturbation model 
stabilization moment Mpf Is zero. 

Incidentally, the floor reaction force horizontal 
component, which Is Increased by changing the horizontal 
5 body position correcting perturbation model stabilization 
moment Mpf from zero to the required value Mpfdmd of 
horizontal body position correcting perturbation model 
stabilization moment, takes a value obtained by dividing 
the required value Mpfdmd of horizontal body position 

10 correcting perturbation model stabilization moment by the 
body translatlonal mode floor reaction force ratio h. 

Hence, as shown by Equation hi 5, the corrected 
desired floor reaction force horizontal component without 
restriction Fin is obtained by adding the aforesaid 

15 determined full-model floor reaction force horizontal 
component Ffull to the value obtained by dividing the 
required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment by the 
body translatlonal mode floor reaction force ratio h, and 

20 further by adding the calculated value FO of the floor 
reaction force of the body position correcting 
perturbation model when it is assumed that the horizontal 
body position correcting perturbation model stabilization 
moment Mpf is zero. 

25 

Fin = 1/h * Mpfdmd + Ffull + FO ... Equation hl5 
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Subsequently, based on the corrected desired floor 
reaction force moment horizontal component without 
restriction Min and the corrected desired floor reaction 
force horizontal component without restriction Fin, a 
5 corrected desired floor reaction force moment horizontal 
component with restriction Mltd and a corrected desired 
floor reaction force horizontal component with restriction 
Fltd (about a desired ZMP), which are the values that have 
restrictions added thereto, are determined by a 

10 restricting means (restriction processing unit) 211. In 
the present embodiment, a desired floor reaction force 
moment horizontal component for compliance control agrees 
with the corrected desired floor reaction force moment 
horizontal component with restriction Mltd, and the floor 

15 reaction force horizontal component of a corrected gait 
agrees with a corrected desired floor reaction force 
horizontal component with restriction Fltd. 

The corrected desired floor reaction force moment 
horizontal component with restriction Mltd and the 

20 corrected desired floor reaction force horizontal 

component with restriction Fltd are determined such that 
the true ZMP of the corrected gait (including the desired 
floor reaction force moment horizontal component for 
compliance control) falls within the aforesaid ZMP 

25 permissible range and the floor reaction force horizontal 
component of the corrected gait falls within a floor 
reaction force horizontal component permissible range. In 
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other words, Mltd and Fltd are determined such that the 
ZMP restrictive condition and the floor reaction force 
horizontal component restrictive condition are satisfied. 
Furthermore, under the aforesaid restrictive 
5 condition, a horizontal body position correcting 

perturbation model stabilization moment Mp is determined 
to agree with or approximate to the required value Mpf dmd 
of horizontal body position correcting perturbation model 
stabilization moment as much as possible. Similarly, a 

10 body posture inclination angle correcting perturbation 

model stabilization moment Mr is determined to be a value 
that agrees with or approximate to the required value 
Mrfdmd of body posture inclination angle correcting 
perturbation model stabilization moment as much as 

15 possible. This stabilizes the aforesaid correcting 

perturbation model body position Xc and the aforesaid 
correcting perturbation model body posture inclination 
angle Qc, thus preventing divergence. 

The details of the restricting means (restriction 

20 processing unit) 211 are given in PCT/ JP03/00435 

previously proposed by the present applicant, so that 
further explanation will be omitted herein. 

Subsequently, according to the following equation, 
the horizontal body position correcting perturbation model 

25 stabilization moment Mpf and the body posture inclination 
angle correcting perturbation model stabilization moment 
Mrf are determined by an Mpf calculator 212 and an Mrf 
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calculator 213, respectively. 

Mpf = (Fltd - Ffull - FO) * h ... Equation h20 
Mrf = Mltd - Mpf - Mdmdxy ... Equation h21 

More specifically, the Mpf calculator 212 multiplies 
the value, which is obtained by subtracting the full-model 
floor reaction force horizontal component Ffull from the 
corrected desired floor reaction force horizontal 
component with restriction Fltd and subtracting therefrom 
the calculated value FO of the floor reaction force of the 
body position correcting perturbation model 202 in the 
case where Mp is assumed to be zero, by the body 
translational mode floor reaction force ratio h so as to 
obtain the horizontal body position correcting 
perturbation model stabilization moment Mpf. The Mrf 
calculator 213 subtracts the aforesaid horizontal body 
position correcting perturbation model stabilization 
moment Mpf and the compensating total floor reaction force 
moment horizontal component Mdmdxy from the corrected 
desired floor reaction force moment horizontal component 
with restriction Mltd about the desired ZMP to obtain the 
body posture inclination angle correcting perturbation 
model stabilization moment Mrf. 

Subsequently, according to the equations shown below, 
the horizontal body position correcting perturbation model 
floor reaction force moment Mp and the body posture 
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Inclination angle correcting perturbation model floor 
reaction force moment Mr are determined* 

Mp = Mpf - Mfull ... Equation h22 

5 Mr = Mrf ... Equation h23 

This means that an Mp calculator 214 subtracts a 
full-model floor reaction force moment horizontal 
component Mfull from the horizontal body position 

10 correcting perturbation model stabilization moment Mpf to 
obtain the horizontal body position correcting 
perturbation model floor reaction force moment Mp, The 
body posture Inclination angle correcting perturbation 
model floor reaction force moment Mr takes the same value 

15 as that of the body posture inclination angle correcting 
perturbation model stabilization moment Mrf. 

Subsequently, the horizontal body position correcting 
perturbation model floor reaction force moment Mp is 
supplied to the body position correcting perturbation 

20 model 202 in which the correcting perturbation model body 
position Xc balancing the supplied floor reaction force 
moment is calculated. 

Further, the body posture inclination angle 
correcting perturbation model floor reaction force moment 

25 Mr is supplied to the body posture inclination angle 

correcting perturbation model 203 in which the correcting 
perturbation model body posture inclination angle Oc 
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balancing the supplied floor reaction force moment 
horizontal component Is calculated. 

Subsequently, calculators 205 and 204 determine a 
corrected desired horizontal body position and a corrected 
desired body posture Inclination angle according to the 
following Equation h24 and Equation h25, respectively, and 
the determined values are output as the final desired 
Instantaneous values of the horizontal body 
position/posture . 

Corrected desired horizontal body position 

= Simplified model horizontal body position + Corrected 

perturbation model body position Xc 

... Equation h24 

Corrected desired body posture inclination angle 
= Simplified model body posture inclination angle + 
Corrected perturbation model body posture inclination 
angle 6c 

... Equation h25 

In other words, the correcting perturbation model 
body position Xc is added to the simplified model 
horizontal body position to obtain the corrected desired 
horizontal body position, and this is output as a final 
desired horizontal body position. The correcting 
perturbation model body posture inclination angle Oc is 
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added to the simplified model body posture Inclination 
angle to provide the corrected desired body posture 
Inclination angle, and this Is output as a final desired 
body posture Inclination angle. 
5 In addition, the corrected desired floor reaction 

force moment horizontal component with restriction Mltd Is 
output as a desired floor reaction force moment horizontal 
component for compliance control about the desired ZMP, 
and a corrected desired floor reaction force horizontal 

10 component with restriction Fltd is output as a corrected 
desired floor reaction force horizontal component. 

More specifically, according to Equation h26 and 
Equation h27 shown below, the corrected desired floor 
reaction force horizontal component and the corrected 

15 desired floor reaction force moment horizontal component 
about the desired ZMP are determined as the final desired 
instantaneous values of the floor reaction force 
horizontal component and the floor reaction force moment 
horizontal component (the moment horizontal component 

20 about the desired ZMP), respectively, and these are output. 

Desired floor reaction force moment horizontal component 
for compliance control 

= Corrected desired floor reaction force moment horizontal 
25 component with restriction Mltd 

... Equation h26 
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Corrected desired floor reaction force horizontal 
component 

= Corrected desired floor reaction force horizontal 
component with restriction Fltd 

... Equation h27 

The processing up to the above In S3536 Is as per 
PCT/JP03/00435 by the present applicant, so that no 
further explanation will be given. 

Further, In the fourth reference example, an 
antiphase arm swing angle correcting perturbation model 
moment Ma and a desired floor reaction force moment 
vertical component to be Input to the antiphase arm swing 
angle correcting perturbation model 231 are determined In 
the antiphase arm swing angle correcting perturbation 
model moment determiner 230. Then, an antiphase arm swing 
angle correcting perturbation model moment Ma Is Input to 
the antiphase arm swing angle correcting perturbation 
model 231 to determine a correcting perturbation model 
antiphase arm swing angle 6ca. 

Supplementally, the antiphase arm swing angle 
correcting perturbation model moment determiner 230 
determines a feedback amount (manipulated variable) 
according to a feedback control law, such as the PI 
control, on the basis of the state of the antiphase arm 
swing angle correcting perturbation model 231 so that a 
corrected desired antiphase arm swing angle, that Is, the 
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arm swing angle obtained by adding a correcting 
perturbation model antiphase arm swing angle to a desired 
antiphase arm swing angle based on a simplified model, 
stabilizes to or follows a reference antiphase arm swing 
5 angle (determined In S3404 of Fig. 57) output by the 

desired Instantaneous value generator 100b or a desired 
antiphase arm swing angle (obtained In S3414 of Fig. 57) 
based on a simplified model, and the determined feedback 
amount Is additionally Input to the antiphase arm swing 

10 angle correcting perturbation model 231. 

This control law Is referred to as an "antiphase arm 
swing angle correcting perturbation model control law," 
and the feedback amount (manipulated variable) Is referred 
to as a "required value Mafdmd of perturbation model 

15 stabilization moment for correcting antiphase arm swing 

angle." The term required value" has been added for the 
same reason as that for the required value Mpf dmd of 
perturbation model stabilization moment for correcting 
horizontal body position. The moment corrected by adding 

20 restriction thereto Is referred to as "perturbation model 
stabilization moment Maf for correcting antiphase arm 
swing angle." In the present embodiment, this Maf Is 
supplied as an antiphase arm swing angle correcting 
perturbation model moment Ma to the antiphase arm swing 

25 angle correcting perturbation model 231. 

Specifically, the antiphase arm swing angle 
correcting perturbation model control law for determining 
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the required value Mafdmd of perturbation model 
stabilization moment for correcting antiphase arm swing 
angle is Implemented according to the equation given below. 

Required value Mafdmd of perturbation model stabilization 
moment for correcting antiphase arm swing angle 
= Kap * (Correcting perturbation model antiphase arm swing 
angle Oca 

- (Reference antiphase arm swing angle - Desired 
antiphase arm swing angle based on simplified model)) 
+ Kav * Correcting perturbation model antiphase arm swing 
angular velocity dSca/dt 

... Equation h30 
where Kap and Kav denote feedback control law gains. 

In Equation hSO, (Reference antiphase arm swing angle 
- Desired antiphase arm swing angle based on simplified 
model) may be replaced by zero. 

The operation of the antiphase arm swing angle 
correcting perturbation model moment determiner 230 will 
be explained in conjunction with Fig. 70 showing the 
functional block diagram thereof. 

First, as described above, the required value Mafdmd 
of perturbation model stabilization moment for correcting 
antiphase arm swing angle is determined according to the 
antiphase arm swing angle correcting perturbation model 
control law 230a (Equation h30). 
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Subsequently, a floor reaction force moment vertical 
component perturbation amount Mpz resulting from the 
correction of a horizontal body position using the 
horizontal body position correcting perturbation model 202 
5 is determined by a calculator 230b of a floor reaction 
force moment vertical component perturbation amount 
resulting from a correction of a horizontal body position. 

Specifically, it is determined according to the 
following equation. 

10 

Mpz = (Position of simplified model body mass point 

+ Correcting perturbation model body position Xc - 
Desired ZMP) 

* (Simplified model body mass point horizontal 
15 acceleration 

+ Correcting perturbation model body acceleration 
d2Xc/dt2) 

- (Simplified model body mass point position - 
Desired ZMP) 

20 * (Simplified model body mass point horizontal 

acceleration ) 

• Equation h31 
Alternatively, the following equation approximating 
the above equation may be used. 

25 

Mpz « Correcting perturbation model body position Xc 
* (Simplified model body mass point horizontal 
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acceler at Ion 

+ Correcting perturbation model body 
acceleration d2Xc/dt2) 

+ (Simplified model body mass point position - Desired 

ZMP) 

* Correcting perturbation model body acceleration 
d2Xc/dt2) 

... Equation h32 

Subsequently, if it is assumed that the antiphase arm 
swing angle correcting perturbation model stabilization 
moment Maf is matched with the required value Maf dmd of 
antiphase arm swing angle correcting perturbation model 
stabilization moment, and a desired floor reaction force 
moment vertical component for compliance control as a 
desired floor reaction force moment vertical component 
about a desired ZMP is matched with the total sxim of the 
compensating total floor reaction force moment vertical 
component Mdmdz, Maf, Mfullz, and Mpz, while Ignoring the 
aforesaid restrictive condition on floor reaction force 
moment vertical component, then the floor reaction force 
moment vertical component Minz generated about the desired 
ZMP is determined by a calculator 230c. This floor 
reaction force moment vertical component is referred to as 
'•corrected desired floor reaction force moment vertical 
component without restriction Minz . " The corrected 
desired floor reaction force moment vertical component 
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without restriction Minz is determined according to the 
following equation. 

Minz = Mafdmd + Mdmdz + Mfullz + Mpz ... Equation h33 

5 

This means that the corrected desired floor reaction 
force moment vertical component without restriction Minz 
is obtained by adding the required value Mafdmd of 
antiphase arm swing angle correcting perturbation model 

10 stabilization moment, the compensating total floor 

reaction force moment vertical component Mdmdz, the full- 
model floor reaction force moment vertical component 
Mfullz, and the horizontal body position correcting 
perturbation model moment vertical component Mpz . 

15 Subsequently, based on the corrected desired floor 

reaction force moment vertical component without 
restriction Minz, a corrected desired floor reaction force 
moment vertical component with restriction Mltdz (about a 
desired ZMP), which is the value that has added 

20 restriction thereto, is determined by a restricting means 
(restriction processing unit) 230d. In the fourth 
reference example, a desired floor reaction force moment 
vertical component for compliance control agrees with the 
corrected desired floor reaction force moment vertical 

25 component with restriction Mltdz, 

The corrected desired floor reaction force moment 
vertical component with restriction Mltdz is determined 
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such that it falls within a floor reaction force moment 
vertical component permissible range. In other words, 
Mltdz is determined so that it satisfies a floor reaction 
force moment vertical component restrictive condition. 

Furthermore^ under the aforesaid floor reaction force 
moment vertical component restrictive condition, the 
antiphase arm swing angle correcting perturbation model 
stabilization moment Maf is determined to agree with or be 
as close as possible to the required value Mafdmd of 
antiphase arm swing angle correcting perturbation model 
stabilization moment. This stabilizes the aforesaid 
correcting perturbation model antiphase eirm swing angle 
Oca, thus preventing divergence. 

A restricting means (restriction processing unit) 
230d is a function having a saturation characteristic 
represented by the following equation. 

If Minz > Upper limit value of a floor reaction force 
moment vertical component permissible range, then 

Mltdz = Upper limit value of the floor reaction force 
moment vertical component permissible range. 

If Minz < Lower limit value of a floor reaction force 
moment vertical component permissible range, then 

Mltdz = Lower limit value of the floor reaction force 
moment vertical component permissible range. 

If the lower limit value of a floor reaction force 
moment vertical component permissible range ^ Minz, and 
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Mlnz ^ Upper limit value of the floor reaction force 
moment vertical component permissible range, then 
Mltdz = Mlnz 

Equation h34 

Supplementally, according to the equation shown below, 
an antiphase arm swing angle correcting perturbation model 
moment Ma (= Antiphase arm swing angle correcting 
perturbation model stabilization moment Maf ) Is determined 
by a Maf calculator 230e. 

Ma = Mltdz - (Mdmdz + Mfullz + Mpz) ... Equation h35 

This means that In the Maf calculator 230e, an 
antiphase arm swing angle correcting perturbation model 
moment Ma as the antiphase ajcm swing angle correcting 
perturbation model stabilization moment Maf Is obtained by 
subtracting the compensating total floor reaction force 
moment vertical component Mdmdz, the full-model floor 
reaction force moment vertical component Mfullz, and the 
horizontal body position correcting perturbation model 
moment vertical component Mpz from the corrected desired 
floor reaction force moment vertical component with 
restriction Mltdz, 

Meanwhile, the corrected desired floor reaction force 
moment vertical component with restriction Mltd is output 
as the desired floor reaction force moment vertical 
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component for compliance control about a desired ZMP. 

More specifically, according to the following 
Equation h35, a corrected desired floor reaction force 
moment vertical component about the desired ZMP Is 
determined as the final desired Instantaneous value of the 
floor reaction force moment vertical component (the moment 
vertical component about the desired ZMP), these are 
output . 

Desired floor reaction force moment vertical component for 
compliance control 

= Corrected desired floor reaction force moment vertical 
component with restriction Mltdz 

... Equation h36 

After the processing of the antiphase arm swing angle 
correcting perturbation model moment 230 is carried out as 
described above, the antiphase arm swing angle correcting 
perturbation model moment Ma is supplied to the antiphase 
arm swing angle correcting model 231 shown in Fig. 66, and 
the correcting perturbation model antiphase arm swing 
angle 6ca that balances with the supplied antiphase arm 
swing angle correcting perturbation model moment Ma is 
calculated by using Equation a23c (by integrating) . 

Subsequently, in the calculator 232, the corrected 
desired antiphase arm swing angle is determined according 
to the following Equation h37, and this is output as the 
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final desired Instantaneous value of the antiphase arm 
swing angle. 

Corrected desired antiphase arm swing angle 

= Simplified model antiphase arm swing angle 

+ Correcting perturbation model antiphase arm swing angle 

eca 

... Equation h37 

This means that the corrected desired antiphase arm 
swing angle Is obtained by adding the correcting 
perturbation model antiphase arm swing angle 0ca to the 
simplified model antiphase arm swing angle, and this Is 
output as the final desired antiphase arm swing angle. 

The gait correction of S3536 Is made as described 
above . 

Supplementally, the fourth reference example Is the 
feedforward type correction, and the perturbation dynamic 
models are not precise models. For this reason, even If 
gaits are corrected so as to satisfy Equation h5. Equation 
h6, and Equation hl006, as described above, dyneunlc 
balance conditions are not satisfied in the strict sense 
although the dynamic balance conditions are approximately 
satisfied. 

Furthermore, in the fourth reference example, at the 
end of a one-step gait (the end of the current time gait), 
for example, the state amounts of the horizontal body 
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position correcting perturbation model 202, the body 
posture Inclination angle correcting perturbation model 
203, and the antiphase arm swing angle correcting 
perturbation model 231, e.g., the horizontal position of 
5 the body mass point (the inverted pendulum mass point) of 
the horizontal body position correcting perturbation model 

202, the rotational angle of the flywheel of the body 
posture inclination angle correcting perturbation model 

203, and the rotational angle of the flywheel of the 

10 antiphase arm swing angle correcting perturbation model 

231 are added as the state amount of the simplified model 
200. In other words, the state amount of the simplified 
model 200 at the end of the current time gait is corrected 
to the state amount obtained by adding the body motion of 

15 the horizontal body position correcting perturbation model 
202 and the state amounts of the body posture inclination 
angle correcting perturbation model 203 and the antiphase 
arm swing angle correcting perturbation model 231. 
Further, the state amount of each of the perturbation 

20 models 202, 203, and 231 is initialized (e.g., the 

horizontal position of the body mass point (the Inverted 
pendulum mass point) of the horizontal body position 
correcting perturbation model 202, the rotational angle of 
the flywheel of the body posture inclination angle 

25 correcting perturbation model 203, and the rotational 
angle of the flywheel of the antiphase arm swing angle 
correcting perturbation model 231 are reset to zero). 
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Then, a next time gait Is generated, taking the state 
amount of the simplified model 200 that has been corrected 
as described above as the initial value of the next time 
gait, and the correcting perturbation model horizontal 
body position Xc, the correcting perturbation model body 
posture inclination angle 6c, and the correcting 
perturbation model antiphase arm swing angle Gca of the 
individual perturbation models 202, 203, and 231 are 
calculated. This makes it possible to further enhance the 
stability of the behaviors of the individual perturbation 
models 202, 203, and 231. The state amounts of the 
simplified model 200 described above may be corrected as 
necessary while a gait is being generated. Conversely, 
the correction of the state amounts of the simplified 
model 200 or the resetting of the perturbation models 
described above may not be carried out while a gait is 
being generated. 

The aforesaid correction of state amounts of the 
simplified model 200 will be implemented in the same 
manner in a fifth and a sixth reference examples, which 
will be discussed hereinafter. 

In the fourth reference example, the aforementioned 
restoring conditions are all satisfied. Accordingly, the 
same operations and advantages as those of the 
aforementioned third reference excunple can be obtained. 

Furthermore, in addition to the operations and 
advantages of the third reference example, the calculation 
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volvune can be reduced to be relatively small when 
determining a horizontal body position, a body posture 
inclination angle, and an antiphase arm swing angle so 
that the aforementioned restoring conditions are satisfied. 

A fifth reference example will now be explained with 
reference to Fig. 71 and Fig. 72. The correcting 
technique of a device according to the fifth reference 
example differs from that of the aforesaid fourth 
reference example only in the processing of the gait 
generating device 100 (the processing of S3536 of Fig. 65), 
and it is a full-model feedback correction type. It is a 
technique using an inverse dynamic full model (inverse 
full model) . This technique does not correct an input of 
a simplified model gait, and uses a perturbation model. 

Fig. 71 is a functional block diagram explaining an 
operation of the device according to the fifth reference 
example, specifically, the gait correcting technique of 
S3536 of the flowchart of Fig. 65. However, a simplified 
model 200 shown in Fig. 71 represents not only a dynamic 
model but also the processing from S3510 to S3532 of Fig. 
65, i.e., the processing for calculating (determining) a 
simplified model gait instantaneous value, as in the case 
of the aforesaid fourth reference example. Hence, in Fig. 
71, the portion beyond the simplified model 200 
corresponds to the processing of S3536. Of the functional 
portions in Fig. 71, like functional portions as those in 
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Fig. 66 related to the fourth reference example will be 
assigned like reference marks in Fig. 66 and detailed 
explanation thereof will be omitted. 

Since the construction other than the processing of 
S3536 is the same as that of the fourth reference example, 
the explanation thereof will be omitted, and the following 
will explain the processing of S3 536 in detail in 
conjunction with Fig. 71. 

In S3536, first, as previously described, a 
correcting perturbation model horizontal body position Xc 
calculated, which will be discussed later, at the last 
time control cycle (time t - At) is added by a calculator 
205 to an instantaneous value (a provisional instantaneous 
value determined in the control cycle at current time t) 
of a desired horizontal body position of a simplified 
model gait determined in S3532 of Fig. 65, thereby 
determining a final desired horizontal body position 
(corrected desired horizontal body position). Further, a 
correcting perturbation model body posture inclination 
angle Sc, which will be discussed later, calculated in the 
last time control cycle (time t - At) is added by a 
calculator 204 to an instantaneous value (a provisional 
instantaneous value determined in the control cycle at 
current time t) of a desired body posture inclination 
angle of a simplified model gait determined in S3 53 2 of 
Fig. 65, thereby determining a final desired body posture 
inclination angle (corrected desired body posture 
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Inclination angle) . Further, a correcting perturbation 
model antiphase arm swing angle 6ca, which will be 
discussed later, calculated In the last time control cycle 
(time t - At) Is added by a calculator 232 to an 
5 Instantaneous value (provisional Instantaneous value 

determined In the control cycle at current time t) of a 
desired antiphase arm swing angle of a simplified model 
gait determined In S3532 of Fig. 65, thereby determining a 
final desired antiphase arm swing angle (corrected desired 

10 antiphase arm swing angle) . 

Then, these corrected desired horizontal body 
position, corrected desired body posture Inclination angle, 
and corrected desired antiphase arm swing angle are output 
as the final desired Instantaneous values of the 

15 horizontal body position, the body posture Inclination 
angle, and the antiphase arm swing angle, respectively. 

More specifically, the corrected desired horizontal 
body position, the corrected desired body posture 
Inclination angle, and the corrected desired antiphase arm 

20 swing angle are determined according to the aforesaid 
Equation h24. Equation h25, and Equation h37. 

Subsequently, the desired horizontal body position 
(the corrected desired horizontal body position), the 
desired body posture inclination angle (the corrected 

25 desired body posture Inclination angle), and the desired 

antiphase arm swing angle (the corrected desired antiphase 
arm swing angle) obtained by correcting the simplified 
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model gait as described above, and the Instantaneous 
values of the motional variables, such as the desired 
center-of -gravity position, the desired foot 
position/posture, and the desired arm posture, of the 
simplified model gait obtained as previously described, 
and the Instantaneous value of the desired ZMP are Input 
to the aforesaid Inverse dynamic full model 201, and then 
the floor reaction force horizontal component and the 
floor reaction force moment about the desired ZMP (a 
horizontal component and a vertical component) that 
balance with the motion expressed by the Input motional 
variables (I.e., that are generated by the Inverse full 
model 201 by the motion) are calculated. Thus, according 
to the fifth reference example. In addition to the 
simplified model horizontal body position, body posture 
Inclination angle, and antiphase arm swing angle, the 
correcting perturbation model horizontal body position Xc, 
the correcting perturbation model body posture Inclination 
angle Oc, and a correcting perturbation model antiphase 
arm swing angle Oca are also Input to the Inverse full 
model 201. Hereinafter, as In the fourth reference 
example, the floor reaction force horizontal component, 
the floor reaction force moment horizontal component, and 
the floor reaction force moment vertical component 
calculated by the Inverse full model 201 will be referred 
to as a full-model floor reaction force horizontal 
component Ffullxy, a full -model floor reaction force 
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moment horizontal component Mfullxy, and a full -model 
floor reaction force moment vertical- component Mf ullz , 
respectively- 

The full -model floor reaction force horizontal 
component Ffull is output as a corrected desired floor 
reaction force horizontal component (a final desired 
instantaneous value of the floor reaction force horizontal 
component at the current time t ) . 

More specifically, a corrected desired floor reaction 
force horizontal component is determined according to the 
equation given below and output. 

Corrected desired floor reaction force horizontal 
component = Full -model floor reaction force horizontal 
component Ffull 

... Equation h48 

As can be seen from the above processing, according 
to the fifth reference example, a full-model corrected 
gait is constituted by adding a behavior of the horizontal 
body position correcting perturbation model 202, a 
behavior of the body posture inclination angle correcting 
perturbation model 203, and a behavior of the antiphase 
arm swing angle correcting perturbation model 231 to a 
simplified model gait. Further, the equation shown below 
holds, considering that the floor reaction force 
horizontal component generated by the body inclination 
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mode and the floor reaction force horizontal component 
generated by the antiphase arm swing mode are both zero. 
However, a simplified model floor reaction force 
horizontal component is the translatlonal force horizontal 
component of the floor reaction force generated by a 
motion of a simplified model gait, the floor reaction 
force being calculated using the inverse full model 201. 

Full-model floor reaction force horizontal component Ffull 
= Simplified model floor reaction force horizontal 
component 

+ Horizontal body position correcting perturbation model 
floor reaction force horizontal component Fp 

... Equation h51 

Subsequently, a required value Mpfdmd of horizontal 
body position correcting perturbation model stabilization 
moment is determined according to a horizontal body 
position correcting perturbation model control law 206. 
The horizontal body position correcting perturbation model 
control law 206 in the present embodiment is set as 
proposed by the present applicant in Japanese Patent 
Application No. 2001-133621. For example, the control law 
206 is determined according to the following equation. 

Required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment 
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= Kpg * Difference In center of gravity + Kvg * 
Correcting perturbation model horizontal body velocity 
dXc/dt 

... Equation h52 
5 where the difference In center of gravity Is 

determined according to the following equation. 

Difference In center of gravity = Horizontal position of 
full -model center of gravity - Horizontal position of 
10 simplified model center of gravity 

... Equation h53 
where Kpg and Kvg In Equation h52 denote the gains of 
a feedback control law, and the horizontal position of 
full-model center of gravity, the horizontal position of 

15 simplified model center of gravity, and the correcting 

perturbation model horizontal body velocity dXc/dt denote 
the horizontal position of the center of gravity of a 
full- model gait Instantaneous value, the horizontal 
position of the center of gravity of a simplified model 

20 gait Instantaneous value (a center -of -gravity horizontal 
position XGs calculated using a simplified model on the 
basis of an Instantaneous posture of a simplified model 
gait), and a correcting perturbation model horizontal body 
velocity dXc/dt, respectively, which are calculated last 

25 time (time t - At), as It will be discussed later. 

More specifically, a perturbation model control 
feedback amount (manipulated variable) is calculated on 
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the basis of the difference In center of gravity obtained 
by subtracting the center -of -gravity horizontal position 
of a simplified model from the center-of -gravity 
horizontal position of a full model and a perturbation 
5 model body velocity, which Is one of the state amounts of 
a perturbation model. Such a perturbation model control 
law makes It possible to control the temporal average 
value of the difference In center of gravity to 
substantially zero. 

10 Subsequently, a required value Mrfdmd of a body 

posture correcting perturbation model stabilization moment 
Is determined according to a body posture Inclination 
angle correcting perturbation model control law 207. For 
this purpose, the same control law as that In the fourth 

15 reference example may be used. Thus, as the control law 

207, the aforesaid Equation hll, for example, may be used. 

Subsequently, a corrected desired floor reaction 
force moment without restriction Min is determined 
(estimated) by a Min calculator 209. As In the fourth 

20 reference example, the corrected desired floor reaction 

force moment without restriction Min is the floor reaction 
force moment horizontal component generated about a 
desired ZMP when a horizontal body position correcting 
perturbation model stabilization moment Mpf is matched 

25 with the required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment, a body 
posture inclination angle correcting perturbation model 
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Stabilization moment Mrf Is matched with the required 
value Mrfdmd of body posture Inclination angle correcting 
perturbation model stabilization moment, and a desired 
floor reaction force moment horizontal component for 
compliance control as a desired floor reaction force 
moment about a desired ZMP Is matched with the total sum 
of a compensating total floor reaction force moment 
horizontal component Mdmdxy, Mpf ^ and Mrf, while Ignoring 
the aforesaid restriction (the ZMP restrictive condition 
and the floor reaction force horizontal component 
restrictive condition). 

A corrected desired floor reaction force moment 
horizontal component without restriction Min is determined 
by the calculation according to the aforesaid Equation hl3, 
as in the fourth reference example. More specifically, 
the corrected desired floor reaction force moment 
horizontal component without restriction Min is obtained 
by adding the required value Mpfdmd of horizontal body 
position correcting perturbation model stabilization 
moment, the required value Mrfdmd of body posture 
inclination angle correcting perturbation model 
stabilization moment, and the compensating total floor 
reaction force moment horizontal component Mdmdxy. 

Furthermore, a corrected desired floor reaction force 
horizontal component without restriction Fin is also 
determined (estimated) by a Fin calculator 210. As in the 
fourth reference example, the corrected desired floor 
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reaction force horizontal component without restriction 
Fin Is the floor reaction force horizontal component 
(corresponding to Ffull) generated by the Inverted full 
model 201 when the horizontal body position correcting 
perturbation model stabilization moment Mpf Is matched 
with the required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment, the 
body posture Inclination angle correcting perturbation 
model stabilization moment Mrf Is matched with the 
required value Mrfdmd of body posture Inclination angle 
correcting perturbation model stabilization moment, and 
the desired floor reaction force moment horizontal 
component for compliance control Is matched with the total 
sum of the compensating total floor reaction force moment 
horizontal component Mdmdxy, Mpf, and Mrf, while Ignoring 
the aforesaid restriction (the ZMP restrictive condition 
and the floor reaction force horizontal component 
restrictive condition) . 

Unlike the fourth reference example, the corrected 
desired floor reaction force horizontal component without 
restriction Fin Is determined according to the following 
equation . 

Corrected desired floor reaction force horizontal 
component without restriction Fin 

= Full -model floor reaction force horizontal component 
Ffull 
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+ 1/h 

* (Required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment 
- Horizontal body position correcting perturbation model 
5 stabilization moment Mpf ) 

... Equation h54 
where the horizontal body position correcting 
perturbation model stabilization moment Mpf uses a last 
time value (the value at time t - At). More specifically, 

10 the difference between the required value Mpfdmd of 

horizontal body position correcting perturbation model 
stabilization moment and the horizontal body position 
correcting perturbation model stabilization moment Mpf is 
determined, and the amount of an increase in a full-model 

15 floor reaction force horizontal component Ffull resulting 
from increasing the input of the horizontal body position 
correcting perturbation model by the above difference is 
estimated by dividing the above difference by a body 
translational mode floor reaction force ratio h. Further, 

20 the full-model floor reaction force horizontal component 
Ffull is added thereto so as to estimate the corrected 
desired floor reaction force horizontal component without 
restriction Fin. 

Subsequently, based on the corrected desired floor 

25 reaction force moment horizontal component without 

restriction Min and the corrected desired floor reaction 
force horizontal component without restriction Fin, a 
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corrected desired floor reaction force moment horizontal 
component with restriction Mltd and a corrected desired 
floor reaction force horizontal component with restriction 
Fltd (about a desired ZMP)^ which are the values that have 
5 added restriction thereto, are determined by a restricting 
means (restriction processing unit 211) similar to that In 
the fourth reference example such that the aforesaid 
restrictions (the ZMP restrictive condition and the floor 
reaction force horizontal component restrictive condition) 
10 are satisfied. This processing technique Is the same as 
that In the fourth reference exeunple. 

In the fifth reference example also, the desired 
floor reaction force moment horizontal component for 
compliance control Is matched with the corrected desired 
15 floor reaction force moment horizontal component with 

restriction Mltd, and the corrected desired floor reaction 
force horizontal component substantially agrees with the 
corrected desired floor reaction force horizontal 
component with restriction Fltd; therefore, the desired 
20 floor reaction force moment horizontal component for 
compliance control and the corrected desired floor 
reaction force horizontal component substantially satisfy 
the ZMP restrictive condition and the floor reaction force 
horizontal component restrictive condition by determining 
25 the corrected desired floor reaction force moment 
horizontal component with restriction Mltd and the 
corrected desired floor reaction force horizontal 
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component with restriction Pltd as described above. 

Subsequently, the horizontal body position correcting 
perturbation model stabilization moment Mpf is determined 
by an Mpf calculator 215. More detailedly, the value 
5 obtained by multiplying the value, which is obtained by 

subtracting the full-model floor reaction force horizontal 
component Ffull from the corrected desired floor reaction 
force horizontal component with restriction Fltd, by the 
gain Kc is integrated by an integrator 215a, and further, 

10 the obtained integrated value is multiplied by the body 
translational mode floor reaction force ratio h to 
determine the horizontal body position correcting 
perturbation model stabilization moment Mpf. In other 
words, the horizontal body position correcting 

15 perturbation model stabilization moment Mpf is obtained 
according to the following equation. 

Mpf = h * / Kc(Fltd - Ffull )dt ... Equation h55 

20 Subsequently, by an Mrf calculator 214, the body 

posture inclination angle correcting perturbation model 
stabilization moment Mrf is determined by subtracting the 
horizontal body position correcting perturbation model 
stabilization moment Mpf and the compensating total floor 

25 reaction force moment horizontal component Mdmdxy from the 
corrected desired floor reaction force moment horizontal 
component with restriction Mltd. In other words, the body 
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posture Inclination angle correcting perturbation model 
stabilization moment Mrf Is obtained according to the 
aforesaid Equation h21. 

Furthermore^ according to the aforesaid Equation h23, 
5 the body posture Inclination angle correcting perturbation 
model floor reaction force moment Mr Is determined. In 
other words, the body posture Inclination angle correcting 
perturbation model stabilization moment Mrf, which is an 
output of the Mrf calculator 214, Is directly determined 
10 as the body posture Inclination angle correcting 

perturbation model floor reaction force moment Mr. 

Subsequently, a full-model floor reaction force 
moment error Merr defined by the following equation Is 
calculated by a Merr calculator 216. 

15 

Full-model floor reaction force moment error Merr 

= Full -model floor reaction force moment horizontal 
component Mfullxy 

- Corrected desired floor reaction force moment horizontal 
20 component with restriction Mltd 

... Equation h56 



Subsequently, an Mp calculator 217 determines the 
horizontal body position correcting perturbation model 
25 floor reaction force moment Mp according to the following 
equation . 



- 346 - 



Mp = Mpf - / Km*Merr dt ... Equation h57 

This means that the value obtained by multiplying the 
full-model floor reaction force moment error Merr by an 
5 integration gain Km is Integrated by the Integrator 217a, 

and the sign of the Integrated value is reversed. Further, 
the output of the integrator 217a is added to the 
horizontal body position correcting perturbation model 
stabilization moment Mpf to determine the horizontal body 

10 position correcting perturbation model floor reaction 
force moment Mp. 

Subsequently, the horizontal body position correcting 
perturbation model floor reaction force moment Mp is 
supplied to the body position correcting perturbation 

15 model 202, and a correcting perturbation model body 

position Xc that balances with the supplied floor reaction 
force moment horizontal component is calculated. 

In addition, the body posture inclination angle 
correcting perturbation model floor reaction force moment 

20 Mr is supplied to a body posture inclination angle 

correcting perturbation model 203, and the correcting 
perturbation model body posture inclination angle Oc that 
balances with the supplied floor reaction force moment 
horizontal component is calculated. 

25 The processing up to the above in S3536 is as per 

PCT/JP03/00435, SO that no further explanation will be 
given . 
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Further In the fifth reference example, an antiphase 
arm swing angle moment correcting perturbation model Ma Is 
determined In the antiphase arm swing angle correcting 
perturbation model moment determiner 230. 
5 Furthermore, the antiphase arm swing angle correcting 

perturbation model moment Ma Is Input to an antiphase arm 
swing angle correcting perturbation model 231 to determine 
a correcting perturbation model antiphase arm swing angle 
Sea. 

10 The following will explain In detail the operation of 

the antiphase arm swing angle correcting perturbation 
model moment determiner 230 In the fifth reference example, 
referring to Fig. 72, which Is a functional block diagram 
thereof . 

15 First, the required value Mafdmd of antiphase arm 

swing angle correcting perturbation model stabilization 
moment Is determined according to an antiphase arm swing 
angle correcting perturbation model control law. For this 
purpose, the same control law as that in the fourth 

20 reference example may be used. Thus, as the control law, 
the aforesaid Equation h30, for example, may be used. 

Subsequently, in a calculator 230g, a corrected 
desired floor reaction force moment vertical component 
without restriction Minz is determined by subtracting the 

25 last time value (an output of an integrator, which will be 
discussed later) of the antiphase arm swing correcting 
perturbation model moment Ma from the sum of the full- 
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model floor reaction force moment vertical component 
Mfullz, the compensating total floor reaction force moment 
vertical component Mdmdz, and the required value Mafdmd of 
antiphase arm swing angle correcting perturbation model 
5 stabilization moment. Then, in a restricting means 

(restriction processing unit) 230h, a restriction is added 
to the corrected desired floor reaction force moment 
vertical component without restriction Minz so that it 
does not exceed a floor reaction force vertical component 

10 moment permissible range (that is, passing it through a 
shown saturation characteristic function), thereby 
determining the corrected desired floor reaction force 
moment vertical component with restriction Mltdz. Next, 
the value obtained by subtracting the sum of the full- 

15 model floor reaction force moment vertical component 

Mfullz, the compensating total floor reaction force moment 
vertical component Mdmdz , and the required value Mafdmd of 
antiphase arm swing angle correcting perturbation model 
stabilization moment from the corrected desired floor 

20 reaction force moment vertical component with restriction 
Mltdz is integrated by an integrator 230i using an 
integration gain Ka so as to determine the antiphase arm 
swing correcting perturbation model moment Ma, which is 
output. In addition, the corrected desired floor reaction 

25 force moment vertical component with restriction Mltdz is 
output as the desired floor reaction force moment vertical 
component for compliance control. 
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The antiphase arm swing correcting perturbation model 
moment Ma and the desired floor reaction force moment 
vertical component for compliance control are determined 
In the antiphase arm swing angle correcting perturbation 
5 model moment determiner 230 as described above. 

The determined correcting perturbation model body 
position Xc, the correcting perturbation model body 
posture Inclination angle Be, the correcting perturbation 
model antiphase arm swing angle Sea, the horizontal body 
10 position correcting perturbation model stabilization 
moment Mpf , and the antiphase arm swing correcting 
perturbation model moment Ma are used as the last time 
values In the next time control cycle (time t + At) as 
previously described. 
15 The rest of the construction and processing are the 

same as those of the fourth reference example. According 
to the fifth reference example, the same operations and 
advantages as those of the fourth reference example can be 
obtained. 

20 

A sixth reference example will now be explained with 
reference to Fig. 73 and Fig. 74. The sixth reference 
example Is based on a technique that generates a gait 
while correcting the gait by using a forward dynamic model 
25 (to be more precise, a pseudo forward dynamic model) in 
place of the Inverse dynamic full model (Inverse full 
model) 201 used In the aforementioned fourth and fifth 
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reference examples . 

Fig. 73 is a functional block diagram explaining an 
operation of a device according to the sixth reference 
example. As shown in Fig. 73, the sixth reference example 
5 is provided with a pseudo forward full model (pseudo 
forward dynamic full model) 222. 

The pseudo forward full model 222 is a model that 
receives the required value Mpfdmd of horizontal body 
position stabilization moment, the required value Mrfdmd 

10 of body posture inclination angle stabilization moment, 
the required value Mafdmd of antiphase arm swing angle 
stabilization moment, a desired ZMP, a desired floor 
reaction force vertical component, a compensating total 
floor reaction force moment horizontal component Mdmdxy, a 

15 compensating total floor reaction force moment vertical 
component Mdmdz, and the motional states of parts 
excluding a body 3, such as desired foot position/posture 
and a desired arm posture, and outputs a desired vertical 
body position, a desired horizontal body position, a 

20 desired body posture inclination angle, a desired 

antiphase arm swing angle, a desired floor reaction force 
moment (a horizontal component and a vertical component) 
for compliance control as the desired floor reaction force 
moment about a desired ZMP, and a desired floor reaction 

25 force horizontal component. A desired value input of the 
pseudo forward full model 222 is generated by a desired 
instantaneous value generator 100b on the basis of a gait 
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parameter determined by a gait parameter determiner 100a, 
as explained with reference to the aforesaid Fig. 63. 

Specifically, the above pseudo forward full model 222 
is represented by the functional block diagram of Fig. 74, 
5 and the portion encircled by a dashed line in Fig. 74 

corresponds to the pseudo forward full model 222. In this 
functional block diagreun, the same functional parts as 
those in Fig. 71 of the aforementioned fifth reference 
example will use the same reference marks as those in Fig. 
10 71. 

A simplified model 200 in Fig. 74 not merely 
represents a dynamic model, but it also represents the 
processing from S3510 to S3532 of Fig. 65 described above, 
namely, the processing for calculating (determining) 

15 simplified model gait instantaneous values. Further, in 
the processing for calculating (determining) a current 
time gait instantaneous value (the gait instantaneous 
value of a simplified model) in S3532, as explained in the 
above fourth reference example, the instantaneous value of 

20 a gait is generated, setting the model manipulation floor 
reaction force moment horizontal component about a desired 
ZMP to zero, then a perturbational motion of a body 
inclination mode that generates a simplified gait body 
posture inclination angle correcting moment Mr (last time 

25 value) , which corresponds to the body posture inclination 
angle correcting perturbation model moment Mr described in 
the third embodiment, a perturbational motion of a body 
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translatlonal mode that generates a simplified model 
horizontal body position correcting moment Mp (last time 
value) , which corresponds to the horizontal body position 
correcting perturbation model moment Mp described In the 
5 third embodiment, and a perturbatlonal motion of an 

antiphase arm swing mode that generates a simplified model 
antiphase arm swing angle correcting moment Ma (last time 
value), which corresponds to the antiphase arm swing angle 
correcting perturbation model moment Ma described In the 

10 fourth reference example are added thereto. Thus, the 
Instantaneous value of a gait output by the simplified 
model 200 Is corrected. 

To explain more specifically. In the processing of 
S3532 of Fig. 65 In the present sixth reference example, 

15 the horizontal body acceleration obtained by adding, as a 
perturbatlonal portion, a horizontal body acceleration 
(d2Xb/dt2) determined according to an equation In which 
the second term of the right side of the aforesaid 
Equation 03y Is equal to Mp (last time value), namely, the 

20 equation of Mp=mb*(Zb-Zzmp)*(d2Xb/dt2) , to the horizontal 
body acceleration determined by the simplified model 200 
Is Integrated to the second order from the beginning of 
the current time gait to current time t, thereby 
determining the Instantaneous value of the horizontal body 

25 position at the current time t In S3414 and S3416 of Fig. 
57, which constitute subroutine processing thereof. 
Furthermore, In S3414 of Fig. 57, the body posture 
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Inclination angular acceleration obtained by adding, as a 
perturbatlonal portion, a body posture Inclination angular 
acceleration (d2eby/dt2) determined according to an 
equation In which the seventh term of the right side of 
5 the aforesaid Equation 03y is equal to Mr (last time 

value), namely, the equation of Mr= J*d26by/dt2 , to the 
body posture inclination angular acceleration determined 
by the simplified model 200 is integrated to the second 
order from the beginning of the current time gait to the 

10 current time t, thereby determining the Instantaneous 

value of the body posture inclination angle at the current 
time t. Furthermore, in S3414 of Fig. 57, the antiphase 
arm swing angular acceleration obtained by adding, as a 
perturbatlonal portion, an antiphase arm swing angular 

15 acceleration (d26az/dt2} determined according to an 

equation in which the eighth term of the right side of the 
aforesaid Equation 03z is equal to Ma (last time value), 
namely, the equation of Ma=Jaz*d26az/dt2 , to the antiphase 
arm swing angular acceleration determined by the 

20 simplified model 200 is Integrated to the second order 

from the beginning of the current time gait to the current 
time t, thereby determining the instantaneous value of the 
antiphase arm swing angle at the current time t. 

Supplementally, for the horizontal body position and 

25 the body posture inclination angle, the description has 
been given of the Instantaneous values on a sagittal 
plane; however, the instantaneous values on a lateral 
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plane are also determined In the same manner. 

In Fig. 74, the portion beyond the simplified model 
200 is the portion that carries out the processing that 
corresponds to the processing of S3536. The processing in 
5 S3536 will be explained in detail in conjunction with Fig. 
74. 

In S3536, first, the horizontal body position of a 
simplified model that has been corrected on the basis of 
the simplified model horizontal body position correcting 

10 moment Mp (to be specific, the last time value in the 

control cycle at time (t-At)) as described above in S3032 
is output as a desired horizontal body position (a final 
desired instantaneous value of the horizontal body 
position at time t). Furthermore, a simplified model body 

15 posture inclination angle that has been corrected on the 

basis of a simplified model body posture inclination angle 
correcting moment Mr (to be specific, the last time value 
in the control cycle at time (t-At)) is output as a 
desired body posture inclination angle (a final desired 

20 instantaneous value of the body posture inclination angle 
at time t). Furthermore, a simplified model antiphase arm 
swing angle that has been corrected on the basis of a 
simplified model antiphase arm swing angle correcting 
perturbation model moment Ma (to be specific, the last 

25 time value in the control cycle at time (t-At)) is output 
as a desired antiphase arm swing angle (a final desired 
instantaneous value of the antiphase arm swing angle at 
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time t ) . 

More specifically, the final desired horizontal body 
position and desired body posture inclination angle are 
determined according to Equation hlOO, Equation hlOl, and 
5 Equation hl02. 

Desired horizontal body position = Simplified model 
horizontal body position ... Equation hi 00 
Desired body posture inclination angle = Simplified model 
10 body posture inclination angle ... Equation hlOl 

Desired antiphase arm swing angle = Simplified model 
antiphase arm swing angle ... Equation hl02 

Subsequently^ the desired horizontal body position 
15 (i.e., the simplified model horizontal body position), the 
desired body posture inclination angle (i.e., the 
simplified model body posture inclination emgle) , the 
desired antiphase arm swing angle (i.e., the simplified 
model antiphase arm swing angle), and the instantaneous 
20 values of the motion variables, such as the desired total 
center-of -gravity position, the desired foot 
position/posture, and the desired arm posture of the 
simplified model gait, and the Instantaneous value of the 
desired ZMP obtained as described above are Input to the 
25 aforesaid Inverse dynamic full model (inverse full model) 
201, and then a floor reaction force horizontal component 
and a floor reaction force moment (a horizontal component 
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and a vertical component) about the desired ZMP that 
balance with the motion represented by the input motional 
variables (i.e., generated by the inverse full model 201 
by the motion) are calculated. Thereafter, as in the 
5 fifth reference example, these calculated floor reaction 
force horizontal component, the floor reaction force 
moment horizontal component, and the floor reaction force 
moment vertical component will be referred to as a full- 
model floor reaction force horizontal component Ffull, the 

10 full-model floor reaction force moment horizontal 

component Mfullxy, and the floor reaction force moment 
vertical component Mfullz. 

As in the fifth reference example, the full-model 
floor reaction force horizontal component Ffull is output 

15 as a desired floor reaction force horizontal component (a 
final desired instantaneous value of the floor reaction 
force horizontal component at time t) . 

The sixth reference example is not provided with a 
body posture inclination angle correcting perturbation 

20 model, a horizontal body position correcting perturbation 
model, and an antiphase arm swing angle correcting 
perturbation model. Therefore, the processing that 
corresponds to the horizontal body position correcting 
perturbation model control law, the body posture 

25 inclination angle correcting perturbation model control 
law, and the antiphase arm swing angle correcting 
perturbation model control law is different from that in 
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the fifth reference example, as It will be discussed later. 

Except for this, after the aforesaid processing, the 
same processing as that for determining the body posture 
inclination angle correcting perturbation model moment Mr, 
5 the horizontal body position correcting perturbation model 
moment Mp, and the antiphase arm swing angle correcting 
perturbation model moment Ma in the fifth reference 
example is carried out until the simplified model body 
posture inclination angle correcting moment Mr, the 

10 simplified model horizontal body position correcting 

moment Mp, and the simplified model antiphase arm swing 
angle correcting moment Ma are determined. In other words, 
the processing of a Min calculator 209, a Fin calculator 
210, a restriction processing unit 211 (restricting means), 

15 an Mpf calculator 215, a Merr calculator 216, an Mrf 

calculator 217 (= Mr calculator), and an Mp calculator 214 
is the same as that in the fifth reference example. 
Moreover, except for the processing that corresponds to 
the antiphase arm swing angle correcting perturbation 

20 model control law, the processing of a simplified model 

antiphase arm swing angle correcting moment determiner 230 
is identical to the processing of the antiphase arm swing 
angle correcting perturbation model moment determiner 230 
in the fifth reference example. In the present sixth 

25 reference example, Mr, Mp and Ma correspond to the body 
posture inclination angle correcting perturbation model 
moment Mr, the horizontal body position correcting 
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perturbation model moment Mp, and the antiphase arm swing 
angle correcting perturbation model moment Ma, 
respectively. In the fifth reference example; however, 
they are Input to the simplified model 200 rather than 
5 being Input to perturbation models, as In the fifth 

reference example. For this reason, the Mr, Mp and Ma are 
referred to as the simplified model body posture 
Inclination angle correcting moment, the simplified model 
horizontal body position correcting moment, and the 

10 simplified model antiphase arm swing angle correcting 
moment In the present sixth reference example. 

The simplified model body posture Inclination angle 
correcting moment Mr, the simplified model horizontal body 
position correcting moment Mp, and the simplified model 

15 antiphase arm swing angle correcting moment Ma determined 
as described above are used as last time values when 
determining (generating) simplified model gait 
Instantaneous values In the next time control cycle (time 
t + At), as previously described. 

20 The rest of the construction and processing Is the 

same as the fifth reference excunple. 

The following will explain the processing for 
determining the required value Mrfdmd of body posture 
Inclination angle stabilization moment, the required value 

25 Mpfdmd of horizontal body position stabilization moment, 

and the required value Maf dmd of antiphase arm swing angle 
stabilization moment with reference to Fig. 73. 
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As shown In Fig. 73, the sixth reference example Is 
provided with a simplified model 223, which Is different 
from the simplified model 200 provided In the pseudo 
forward full model 222, as previously mentioned. The 
5 function of the simplified model 223 In the present sixth 
reference example Is Identical to that of the aforesaid 
simplified model 200, and the simplified model 223 
represents not only a dynamic model but also the 
processing from S3510 to S3532 of Fig. 65 described above, 

10 I.e., the processing for calculating (determining) 
simplified model gait Instantaneous values. The 
simplified model 223, in actual operation, does not 
necessarily have to perform all processing from S3510 to 
S3532 of Fig. 65, as long as it is capable of determining 

15 the Instantaneous values of body posture Inclination 

angles and the instantaneous values of horizontal body 
positions . 

The following will explain in detail the processing 
for determining Mpfdmd and Mrfdmd in the sixth reference 

20 example in conjunction with Fig. 73. 

In the present sixth reference example, the 
differences In the horizontal body position, the body 
posture inclination angle, and the antiphase arm swing 
angle between the gaits generated using the simplified 

25 model 223 and the gaits calculated as described above 

using the aforesaid pseudo forward dynamic full model 222 
are determined by calculators 224, 225 and 228. Then, 
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based on these differences, the required value Mpfdmd of 
horizontal body position stabilization moment, the 
required value Mrfdmd of body posture inclination angle 
stabilization moment, and the required value Mafdmd of 
5 antiphase arm swing angle stabilization moment are 

determined by a feedback control law, such as PID, so as 
to converge the differences to zero. More specifically, 
Mpfdmd is determined by a horizontal body position 
stabilization control law 226 composed of a feedback 

10 control law on the basis of the difference between the 

horizontal body position by the simplified model 223 and 
the horizontal body position by the pseudo forward full 
model 222. Further, Mrfdmd is determined according to a 
body posture inclination angle stabilization control law 

15 227 composed of a feedback control law on the basis of the 
difference between the body posture inclination angle by 
the simplified model 223 and the body posture inclination 
angle by the pseudo forward full model 222. Further, 
Mafdmd is determined according to an antiphase arm swing 

20 angle stabilization control law 229 composed of a feedback 
control law on the basis of the difference between the 
antiphase arm swing angle by the simplified model 223 and 
the antiphase arm swing angle by the pseudo forward full 
model 222. Then, the determined Mpfdmd, Mrfdmd and Mafdmd 

25 are fed back and input to the aforesaid pseudo forward 
dynamic full model. 

In the sixth reference example, the gait generating 
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device 100 outputs a desired ZMP, a desired floor reaction 
force vertical component, desired foot position/posture, 
and a desired arm posture or the like, which are some of 
inputs to the aforesaid pseudo forward dynamic full model 
222, and a desired vertical body position, a desired 
horizontal body position, a desired body posture 
inclination angle, a desired antiphase arm swing angle, a 
desired floor reaction force horizontal component, and a 
desired floor reaction force moment (a horizontal 
component and a vertical component) for compliance control, 
which are outputs from the aforesaid pseudo forward 
dynamic full model 222, as the final desired instantaneous 
values of a current time gait . 

The sixth reference example explained above is 
capable of providing the operations and advantages similar 
to those of the aforementioned fifth reference example. 

In the aforementioned sixth reference example, the 
required value Mrfdmd of body posture inclination angle 
stabilization moment, the required value Mpfdmd of 
horizontal body position stabilization moment, and the 
required value Mafdmd of antiphase arm swing angle 
stabilization moment have been input only to the pseudo 
forward full model 222. Alternatively, however, Mrfdmd, 
Mpfdmd and Mafdmd may be input to the simplified model 223 
or they may be divided and supplied to the simplified 
model 223 and the pseudo forward full model 222. 
Furthermore, the compensating total floor reaction force 
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moment vertical component Mdmdz may be Input to the 
simplified model 223 and a simplified model antiphase arm 
swing angle may be determined such that the Mdmdz is 
additionally generated. 

5 

A seventh reference example of the present invention 
will now be explained with reference to Pig. 75. Fig. 75 
is a functional block diagram illustrating the operation 
of a device according to the seventh reference example, 

10 specifically, a gait correcting technique in S3536 of the 
flowchart of Fig. 65. In Fig. 75, the same functional 
parts as those in the fourth reference example or the 
fifth reference example will use the same reference marks 
as those in Fig. 66 or Fig. 71. 

15 The seventh reference exeunple is provided with a 

horizontal body position correcting perturbation model 202, 
a body posture inclination angle correcting perturbation 
model 203, and an antiphase arm swing angle correcting 
perturbation model 231. The seventh reference example is 

20 also provided with three distributors 220, 221, and 241. 

The distributors 220, 221, and 241 are all defined as 
1-input, 2-output transmission blocks, and they are 
transmission blocks that determine one output on the basis 
of an input (e.g., signal processing of a frequency 

25 characteristic, a dead- zone characteristic, a saturation 
characteristic, or the like is carried out on an input to 
determine one output) and determine the other output such 
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that the sxim of the two outputs agrees or substantially 
agrees with the input. 

A body posture inclination angle correcting moment Mr, 
which is the value (an output of an Mr calculator 214) 
obtained by subtracting a horizontal body position 
correcting perturbation model stabilization moment Mpf and 
a compensating total floor reaction force moment 
horizontal component Mdmdxy from a corrected desired floor 
reaction force moment horizontal component with 
restriction Mltdxy, is supplied to the distributor 220, 
and divided into a body posture inclination angle 
correcting perturbation model input Mri to be supplied to 
the body posture inclination angle correcting perturbation 
model 203 and a simplified model body posture inclination 
angle correcting moment Mrs to be supplied to the 
simplified model 200. At this time, the body posture 
inclination angle correcting perturbation model input Mri 
and the simplified model body posture inclination angle 
correcting moment Mrs are determined (output) such that 
the sum of the body posture inclination angle correcting 
perturbation model input Mri and the simplified model body 
posture inclination angle correcting moment Mrs agrees 
with the body posture inclination angle correcting moment 
Mr. 

To be more specific, the body posture inclination 
angle correcting perturbation model input Mri is 
determined on the basis of the body posture inclination 
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angle correcting moment Mr. For example, the body posture 
inclination angle correcting moment Mr is subjected to the 
processing of signals having a dead- zone characteristic, a 
saturation characteristic or a frequency characteristic so 
5 as to determine body posture inclination angle correcting 
perturbation model input Mri. The result obtained by 
subtracting the body posture inclination angle correcting 
perturbation model input Mri from the body posture 
inclination angle correcting moment Mr is determined as 

10 the simplified model body posture inclination angle 

correcting moment Mrs. To explain more specifically, in 
the seventh reference example, the distributor 220 outputs, 
for example, a low-frequency component (DC component), 
which is obtained by passing an input (Body posture 

15 inclination angle correcting moment Mr=Mltd-Mpf -Mdmdxy) 
through a low-pass filter, as a simplified model body 
posture inclination angle correcting moment Mrs, and also 
outputs the component obtained by subtracting Mrs from the 
input (body posture inclination angle correcting moment 

20 Mr) as the body posture inclination angle correcting 

perturbation model input Mri. In this case, the dead- zone 
characteristic is imparted to the simplified model body 
posture inclination angle correcting moment Mrs, which is 
the low- frequency component (DC component), so that, in a 

25 state wherein an output of the low-pass filter lies within 
a predetermined range centering around a certain 
predetermined value, Mrs is maintained at the 
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predetermined value (e.g., zero). 

The body posture inclination angle correcting 
perturbation model input Mri, which is an output of the 
distributor 220, is supplied to the body posture 
5 inclination angle correcting perturbation model 203, and a 
correcting perturbation model body posture inclination 
angle Qc is determined by the body posture inclination 
angle correcting perturbation model 203. 

The simplified model body posture inclination angle 

10 correcting moment Mrs, which is the other output of the 

distributor 220, is supplied to the simplified model 200. 
This corresponds to supplying the simplified model body 
posture Inclination angle correcting moment Mr to the 
simplified model 200 in Fig. 74 in the aforementioned 

15 sixth reference example. 

The distributor 221 receives a value obtained by 
integrating the value, which is obtained by multiplying a 
full-model floor reaction force moment horizontal 
component error Merr by a gain Km, by an integrator 217a 

20 and reversing the sign thereof. 

An input to the distributor 221 is divided into a 
simplified model horizontal body position correcting 
moment Mps to be supplied to the simplified model 200 and 
an error correcting moment Me to be supplied to a 

25 horizontal body position correcting perturbation model 202, 
as in the case of the distributor 220. To be more 
specific, an error correcting moment Me is determined on 
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the basis of an output of the Integrator 217a. For 
instance, the error correcting moment Me is determined by 
subjecting an output of the integrator 217a (an input of 
the distributor 220) tb the processing of signals having a 
5 dead-zone characteristic, a saturation characteristic or a 
frequency characteristic. The result obtained by 
subtracting the error correcting moment Me from an output 
of the integrator 217a is determined as the simplified 
model body posture inclination angle correcting moment Mrs. 

10 To explain more specifically, in the present seventh 
reference example, the distributor 221 outputs a low- 
frequency component (DC component), which is obtained by 
passing an input (an output of the integrator 217a) 
through a low-pass filter, as a simplified model 

15 horizontal body position correcting moment Mps, and also 

outputs the component obtained by subtracting Mps from the 
input (the output of the integrator 217a) as the error 
correcting moment Me. In this case, the dead- zone 
characteristic is imparted to the simplified model 

20 horizontal body position correcting moment Mps, which is 
the low- frequency component (DC component), so that, in a 
state wherein an output of the low-pass filter lies within 
a predetermined range centering around a certain 
predetermined value, the Mps is maintained at that 

25 predetermined value (e.g., zero). 

The horizontal body position correcting perturbation 
model moment Mp is determined by adding a horizontal body 
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position correcting model stabilization moment Mpf to the 
error correcting moment Me, which Is an output of the 
distributor 221, by an Mp calculator 217b • Then, the 
horizontal body position correcting perturbation model 
5 moment Mp Is supplied to the horizontal body position 
correcting perturbation model 202, and the correcting 
perturbation model horizontal body position Xc Is 
determined by the horizontal body position correcting 
perturbation model 202. 

10 The simplified model horizontal body position 

correcting moment Mps, which Is the other output of the 
distributor 221, Is supplied to the simplified model 200. 
This Is equivalent to supplying the simplified model 
horizontal body position correcting moment Mp to the 

15 simplified model 200 In Fig. 74 of the aforementioned 
sixth reference example. 

An antiphase arm swing angle correcting perturbation 
model moment determiner 230 Is Identical to the antiphase 
arm swing angle correcting perturbation model moment 

20 deteinnlner shown In Fig. 72 used In the fifth reference 
example. However, the antiphase arm swing angle 
correcting perturbation model moment Ma, which Is an 
output shown In Fig. 72, Is supplied to the distributor 
241 rather than being directly supplied to the antiphase 

25 arm swing angle correcting perturbation model 231. In the 
present seventh reference example, therefore, the 
designation of the antiphase arm swing angle correcting 
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perturbation model moment Ma Is modified to the antiphase 
arm swing angle correcting model moment Ma. 

The distributor 241 receives, as an input, the 
antiphase arm swing angle correcting model moment Ma 
determined by the antiphase arm swing angle correcting 
perturbation model moment determiner 230. 

As in the case of the distributor 220, an input to 
the distributor 241 is divided into a simplified model 
antiphase arm swing angle correcting moment Mas to be 
supplied to the simplified model 200 and an antiphase arm 
swing angle correcting perturbation model input Mai to be 
supplied to the antiphase arm swing angle correcting 
perturbation model 231. 

At this time, the antiphase arm swing angle 
correcting perturbation model input Mai and the simplified 
model antiphase arm swing angle correcting moment Mas are 
determined (output) such that the sum of the antiphase arm 
swing angle correcting perturbation model input Mai and 
the simplified model antiphase arm swing angle correcting 
moment Mas agrees with the antiphase arm swing angle 
correcting model moment Ma. 

To be more specific, antiphase arm swing angle 
correcting perturbation model input Mai is determined on 
the basis of the antiphase arm swing angle correcting 
model moment Ma. For example, the antiphase arm swing 
angle correcting model moment Ma is subjected to the 
processing of signals having a dead-zone characteristic, a 
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saturation characteristic or a frequency characteristic so 
as to determine the antiphase arm swing angle correcting 
perturbation model Input Mai. The result obtained by- 
subtracting the antiphase arm swing angle correcting 
5 perturbation model Input Mai from the antiphase arm swing 
angle correcting model moment Ma Is determined as the 
simplified model antiphase arm swing angle correcting 
moment Mas. To explain more specifically. In the seventh 
reference example, the distributor 241 outputs a low- 

10 frequency component (DC component), which Is obtained by 

passing an Input (the antiphase arm swing angle correcting 
model moment Ma) through a low-pass filter, as a 
simplified model antiphase arm swing angle correcting 
moment Mas, and also outputs the component obtained by 

15 subtracting the Mas from the input (antiphase arm swing 
angle correcting model moment Ma) as the antiphase arm 
swing angle correcting perturbation model input Mai. In 
this case, the dead- zone characteristic is Imparted to the 
simplified model antiphase arm swing angle correcting 

20 moment Mas, which is the low- frequency component (DC 

component), such that, in a state wherein an output of the 
low-pass filter lies within a predetermined range 
centering around a certain predetermined value, the Mas is 
maintained at that predetermined value (e.g., zero). 

25 The antiphase arm swing angle correcting perturbation 

model input Mai, which is an output of the distributor 241, 
is supplied to the antiphase arm swing angle correcting 
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perturbation model 231, and a correcting perturbation 
model antiphase arm swing angle 6ca Is determined by the 
antiphase arm swing angle correcting perturbation model 
231. 

5 The simplified model antiphase arm swing angle 

correcting moment Mas, which Is the other output of the 
distributor 241, Is supplied to the simplified model 200. 
This corresponds to supplying the simplified model 
antiphase arm swing angle correcting moment Ma to the 

10 simplified model 200 In Fig. 74 In the aforementioned 
sixth reference example. 

As In the aforesaid sixth reference example, the 
simplified model 200 generates the Instantaneous value of 
a gait such that no floor reaction force moment horizontal 

15 component Is generated about a desired ZMP (with the model 
manipulation floor reaction force moment set to zero) In 
the processing for calculating (determining) the 
Instantaneous value of a simplified model gait, adds a 
perturbational motion of a body Inclination mode that 

20 generates a simplified model body posture inclination 
angle correcting moment Mrs (last time value), adds a 
perturbational motion of a body translatlonal mode that 
generates a simplified model horizontal body position 
correcting moment Mps (last time value), and further adds 

25 a perturbational motion of an antiphase arm swing mode 
that generates the simplified model antiphase arm swing 
angle correcting moment Mas, thereby correcting the 
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Instantaneous value of the gait. 

In the present seventh reference example, in S800 of 
Fig. 43, which Is a part of the processing of S3528 of Fig. 
65, the state amount of a simplified model at the end of 
5 the last time gait Is used as the terminal state of the 

last time gait. Therefore, if there is a moment when Mrs, 
Mps and Mas output to a simplified model from the 
distributors 220, 221, and 241 take values other than zero, 
then the behavior of the simplified model deviates from 

10 its original behavior, so that gait parfiuneters are 

corrected accordingly as necesseazy in S3528. As the 
aforesaid dead- zone range is set to be wider, then the 
absolute values of Mrs, Mps, and Mas become smaller, so 
that the absolute values of the correction amounts of the 

15 gait parameters become also smaller. 

The rest of the construction and processing are the 
same as those of the fifth reference excunple. More 
detailedly, the processing of calculators 204 and 205, a 
calculator for calculating desired horizontal body 

20 positions, a Merr calculator 216, a body posture 

inclination angle correcting perturbation model control 
law 207, a horizontal body position correcting 
perturbation model control law 206, a Mln calculator 209, 
a Fin calculator 210, a restriction processing unit 211, 

25 an Mpf calculator 215, and an antiphase arm swing angle 

correcting perturbation model moment determiner 240 is the 
same as that of the aforementioned fifth reference example. 
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In the present seventh reference excimple, it ±s not 
necessary to carry out the processing for correcting the 
state amount of the simplified model 200 on the basis of 
the state amounts of the perturbation models 202, 203, and 
5 231 at the end of a current time gait or the like, as 

explained in the aforesaid fourth reference example. This 
is because the simplified model body posture inclination 
angle correcting moment Mrs, the simplified model 
horizontal body position correcting moment Mps , and the 

10 simplified model antiphase arm swing angle correcting 

moment Mas are additionally supplied from the distributors 
220, 221, and 241. 

The present embodiment described above is capable of 
providing the operations and advantages similar to those 

15 of the aforesaid fifth reference example or the sixth 
reference example* 

In the present seventh reference example, one of the 
two outputs of each of the distributors 220, 221, and 241 
may be set to zero, the other being matched with an input. 

20 In this case, if, for example, the simplified model 

body posture inclination angle correcting moment Mrs, 
which is an output of the distributor 220, is set to zero, 
the simplified model horizontal body position correcting 
moment Mps, which is an output of the distributor 221, is 

25 set to zero, and the simplified model antiphase arm swing 
angle correcting moment Mas, which is an output of the 
distributor 241, is set to zero, then the same operations 
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and advantages of the fifth reference example will be 
provided (actually, the same construction as that of the 
fifth reference example will be provided) . 

Alternatively^ the value obtained by adding the 
5 horizontal body position correcting model stabilization 
moment Mpf to the error correcting moment Me may be 
supplied to an another distributor^ not shown, and one of 
the outputs thereof may be supplied to the horizontal body 
position correcting perturbation model, while the other 

10 output may be added to the simplified model horizontal 
body position correcting moment Mps. In this case, the 
simplified model horizontal body position correcting 
moment Mps, which is an output of the distributor 221, may 
be set to zero. In other words, the distributor 221 may 

15 be omitted, and the value obtained by multiplying the 

full-model floor reaction force moment error Merr by the 
gain Km may be integrated. The sign of the integrated 
value may be reversed and the integrated value with the 
reversed sign may be added to the horizontal body position 

20 correcting model stabilization moment Mpf. The resulting 
value may be supplied to the another distributor. 

In the fourth to the seventh reference examples 
explained above, the instantaneous value of the current 
25 time gait (the provisional instantaneous value of a 

desired motion) has been determined such that the desired 
ZMP is satisfied, that is, the floor reaction force moment 
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horizontal component about the desired ZMP Is zero. In 
S3532 of Fig. 65. Alternatively, however, the 
Instantaneous value of the current time gait may be 
determined such that a model manipulation floor reaction 
force moment horizontal component Is generated about the 
desired ZMP, as In S3032 of Fig. 56 In the second 
reference example. In this case, the model manipulation 
floor reaction force moment horizontal component may be 
supplied to the gait generating device 100 from the 
compensating total floor reaction force moment horizontal 
component distributor 110, as shown In Fig. 53. 

In the first to the seventh reference examples 
explained above, the compensating total floor reaction 
force moment horizontal component Mdmdxy may be determined 
on the basis of the state amounts of other postures of the 
robot 1, such as total center -of -gravity horizontal 
position/velocity. In place of the body posture 
angle/angular velocity. 

A first embodiment In accordance with the present 
Invention will now be explained with reference to Fig. 76 
to Fig. 83. 

The functional block diagram of a control unit 60 In 
the present embodiment Is shown In Fig. 76. In the 
present embodiment, the same constituent parts or the seune 
functional parts as those of the aforesaid third reference 
example will be assigned the same reference marks as those 
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of the third reference example. 

In comparison with the third reference example (refer 
to Fig. 59), the present embodiment has added thereto a 
slippage determiner 114 that determines the presence of 
5 slippage of an actual robot 1. A slippage determination 

result output from the slippage determiner 114 is supplied 
to a gait generating device 100. The gait generating 
device 100 narrows a floor reaction force horizontal 
component permissible range and a floor reaction force 

10 moment vertical component permissible range that are 

determined on the basis of gait parameters if a slippage 
determination result Indicates the presence of a slippage. 
If a slippage determination result indicates the absence 
of a slippage, then the gait generating device 100 

15 restores the floor reaction force horizontal component 
permissible range and the floor reaction force moment 
vertical component permissible range that are determined 
on the basis of gait parameters . The rest of the 
construction and processing are the same as those of the 

20 aforesaid third reference example. 

The slippage determiner 114 will be explained in 
detail in conjunction with Fig. 79, which is a flowchart 
illustrating the processing thereof. First, a spin 
determining subroutine is implemented in S5210. The spin 

25 determining subroutine proceeds to S5310 of Fig. 80, which 
is the flowchart thereof, to determine a ground angular 
velocity vertical component cosupz of a supporting leg foot 
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22 on the basis of an actual body posture angular velocity 
and a Joint angle command (detection value). Then, the 
processing proceeds to S5312 wherein a changing rate 
dMsupactz/dt of a supporting leg floor reaction force 
moment vertical component, which is the temporal changing 
rate of an actual floor reaction force moment vertical 
component acting on the supporting leg, is deteinnined on 
the basis of a detection value (actual floor reaction 
force) of a 6-axis force sensor 50 of the foot 22. Next, 
the processing proceeds to S5314 wherein it is determined 
whether the absolute value of the ground angular velocity 
vertical component cosupz of the supporting leg foot 22 
exceeds a predetermined value coe. If the absolute value 
exceeds it, then the processing proceeds to S5316 wherein 
the changing rate dMsupactz/dt of the supporting leg floor 
reaction force moment vertical component is divided by the 
aforesaid ground angular velocity vertical component cosupz 
of the supporting leg foot, and the sign of the obtained 
value is reversed to determine an apparent torsion spring 
constant Ksupt of the supporting leg. Then, the 
processing proceeds to S5318 wherein it is determined 
whether Ksupt is smaller than a predetermined value 
Ksuptmin, and if it is smaller, then the processing 
proceeds to S5320 wherein the presence of a spin is 
determined as a spin determination result, or if it is not, 
then the processing proceeds to S5322 wherein the absence 
of a spin is determined as the spin determination result. 
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Furthermore, If it is determined in S5314 that the 
absolute value of the ground angular velocity vertical 
component cosupz of the supporting leg foot does not exceed 
the aforesaid predetermined value coe^ then the processing 
5 proceeds to S5324 wherein the absence of a spin is 

determined as a spin determination result. Determining 
the presence of a spin as described above makes it 
possible to avoid such a situation wherein the presence of 
a spin is erroneously determined when the absolute value 

10 of cosupz exceeds the predetermined value (oe due to flexure 
(elastic deformation) of the foot 22 or the like. 

After finishing the processing of S5210 as described 
above, the processing proceeds to S5212 wherein a 
translational slippage determining subroutine is 

15 implemented. 

The translational slippage determining subroutine 
proceeds to S5410 of Fig. 81, which is the flowchart 
thereof, to determine a ground translational velocity 
horizontal component Vsupxy of a supporting leg foot 22 on 

20 the basis of an actual body posture angular velocity, an 
acceleration detection value, and a joint angle command 
(detection value). Then, the processing proceeds to S5412 
wherein a changing rate dFsupactxy/dt of a supporting leg 
floor reaction force horizontal component, which is the 

25 temporal changing rate of an actual floor reaction force 
horizontal component acting on the supporting leg is 
determined on the basis of a detection value (actual floor 
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reaction force) of the 6 -axis force sensor 50 of the foot 
22. Next, the processing proceeds to S5414 wherein It Is 
determined whether the absolute value of the ground 
translatlonal velocity horizontal component Vsupxy of the 
5 supporting leg foot exceeds a predetermined value Ve. If 
the absolute value exceeds It, then the processing 
proceeds to S5416 wherein the changing rate dFsupactxy/dt 
of the supporting leg floor reaction force horizontal 
component Is divided by the aforesaid ground translatlonal 

10 velocity horizontal component Vsupxy of the supporting leg 
foot 22, and the sign of the obtained value Is reversed to 
determine an apparent shear spring constant Ksups (- 
dFsupactxy/dt) /Vsupxy) of the supporting leg. Then, the 
processing proceeds to S5418 wherein It Is determined 

15 whether Ksups Is smaller than a predetermined value 
Ksupsmln, and If It Is smaller, then the processing 
proceeds to S5420 wherein the presence of a translatlonal 
slippage is determined as a translatlonal slippage 
determination result, or If It Is not, then the processing 

20 proceeds to S5422 wherein the absence of a translatlonal 
slippage Is determined as the translatlonal slippage 
determination result. Furthermore, if it is determined in 
S5414 that the absolute value of the ground translatlonal 
velocity horizontal component Vsupxy of the supporting leg 

25 foot does not exceed the aforesaid predetermined value Ve, 
then the processing proceeds to S5424 wherein the absence 
of a translatlonal slippage Is determined as a 
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translatlonal slippage determination result. Determining 
the presence of a translatlonal slippage as described 
above makes It possible to avoid such a situation wherein 
the presence of a translatlonal slippage Is erroneously 
determined when the absolute value of Ksups exceeds the 
predetermined value Ksupsmln due to flexure (elastic 
deformation) of the foot 22 or the like. 

After finishing the processing of S5212 as described 
above, the processing proceeds to S5214 wherein a slippage 
vibration determining subroutine Is Implemented. 

The slippage vibration determining subroutine 
proceeds to S5510 of Fig. 82, which Is the flowchart 
thereof, and passes the detection value (a translatlonal 
force horizontal component and/or a moment vertical 
component) of the 6-axls force sensor 50 of the foot 22 
through a band-pass filter to extract a slippage vibration 
component. Instead of using the detection value of the 6- 
axls force sensor 50 of the foot 22, the foot 22 may be 
provided with a yaw rate sensor, an acceleration sensor or 
the like to use the detection values thereof. The passing 
frequency band of the band-pass filter Is preset according 
to the material or the like of the sole of the foot 22 and 
a floor surface. Then, the processing proceeds to S5512 
wherein It Is determined whether the absolute value of the 
size of the detected slippage vibration component exceeds 
a certain predetermined value Ampe. If the absolute value 
exceeds the predetermined value, then the processing 
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proceeds to S5514 wherein a slippage vibration 
determination result that indicates the presence of a 
slippage vibration is given. If the absolute value does 
not exceed it, then the processing proceeds to S5516 
5 wherein a slippage vibration determination result that 
indicates the absence of a slippage vibration is given. 

After finishing the processing of S5214 as described 
above, the processing proceeds S5216, and if a spin 
determination result indicates the presence of a spin, or 
10 if a translational slippage determination result indicates 
the presence of a translational slippage, or if a slippage 
vibration determination result indicates the presence of a 
slippage vibration, then the processing proceeds to S5218 
wherein a slippage determination result, which is an 
15 overall determination result, is given to indicate the 
presence of a slippage. If not, then the processing 
proceeds to S5220 wherein the slippage determination 
result, which is the overall determination result, is 
given to indicate the absence of a slippage. This 
20 completes the processing of the slippage determiner 114. 

Fig. 77 shows the flowchart of the main routine 
processing of the gait generating device 100 in the 
present embodiment. 

In this Fig. 77, from S2310 to S2332, the same 
25 processing as that from S2010 to S2032 of the flowchart 
(Fig. 60) of the third reference example is carried out. 
Subsequently, the processing proceeds to S2334 
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wherein a subroutine for determining a corrected gait 
Instantaneous value is Implemented. 

In the present embodiment, a corrected gait 
Instantaneous value determining subroutine determines a 
5 corrected gait Instantaneous value such that a desired ZMP 
and an antiphase arm swing restoring angular acceleration 
pattern are corrected so as to approximate them to an 
original gait, and also a model manipulation floor 
reaction force moment (a horizontal component and a 

10 vertical component) is additionally generated about a 
corrected desired ZMP. The floor reaction force 
permissible range is changed according to a slippage 
determination result. This aspect is different from the 
third reference example. 

15 Fig. 78 shows the flowchart of the corrected gait 

Instantaneous value determining subroutine. In the 
corrected gait Instantaneous value determining subroutine, 
the processing from S5100 to S5114 is first carried out in 
the same manner as that from S2100 to S2112 of Fig. 61, 

20 which is the corrected gait Instantaneous value 

determining subroutine of the third reference excunple. 
Then, the processing proceeds to S5116 wherein it 
determines whether the slippage determination result by 
the aforesaid slippage determiner 114 indicates the 

25 presence of a slippage, and if the slippage determination 
result indicates the presence of a slippage, then the 
processing proceeds to S5118 wherein a permissible range 
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reducing rate att Is gradually approximated to zero 
(decreased substantially continuously). Incidentally, the 
permissible range reducing rate is assumed to take a value 
from 0 to 1. If it is determined in S5116 that the 
5 slippage determination result indicates no slippage, then 
the processing proceeds to S5120 wherein the permissible 
range reducing rate att is gradually approximated to 1 
(increased substantially continuously). 

Subsequently, the processing proceeds to S5122 

10 wherein Fxmin, Fxmax, Mzmin and Mzmax, which are the upper 
limit values and the lower limit values of the permissible 
ranges of the floor reaction force horizontal component 
and the floor reaction force moment vertical component, 
respectively, determined in S5110 and S5112, are 

15 multiplied by the permissible range reducing rate att so 

as to narrow the floor reaction force horizontal component 
permissible range and the floor reaction force moment 
vertical component permissible range. Hereinafter, the 
floor reaction force horizontal component permissible 

20 range and the floor reaction force moment vertical 

component permissible range detezinined in this S5122 will 
be generically referred to as "final floor reaction force 
permissible ranges." It is a matter of course that, if 
the reducing rate is 1, then the final floor reaction 

25 force permissible range agrees with the permissible ranges 
of the floor reaction force horizontal component and the 
floor reaction force moment vertical component determined 
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in S5110 and S5112 (hereinafter referred to as "original 
floor reaction force permissible ranges" in some cases), 
and the original floor reaction force permissible ranges 
will not be narrowed. 
5 Fig. 83 shows an example illustrating how the 

permissible range reducing rate att, the final floor 
reaction force permissible ranges (specifically, a floor 
reaction force horizontal component permissible range and 
a floor reaction force moment vertical component 

10 permissible range) change according to slippage 
determination results. 

If a slippage occurs, the robot 1 may fall unless a 
gripping state is promptly restored. Hence, if it is 
determined that a slippage has occurred, then the final 

15 floor reaction force permissible range should be quickly 
narrowed. However, unduly sudden narrowing would lead to 
an excessive change in acceleration of a gait with a 
resultant impact; therefore, a proper value that does not 
lead to a sudden change should be set. 

20 If it is determined that there is no longer a 

slippage, then the final floor reaction force permissible 
range should be quickly set back to the original floor 
reaction force pezmissible range. If the final floor 
reaction force permissible range remains narrower, then a 

25 corrected gait will significantly deviate from an original 
gait. However, unduly sudden restoration would lead to an 
excessive change in acceleration of the motion of the gait. 
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resulting in a slippage again due to an Impact; therefore, 
a proper value that does not cause an unduly sudden 
restoration should be set. 

Subsequently, the processing proceeds to S5124 
5 wherein a model manipulation floor reaction force moment 
horizontal component, a desired floor reaction force 
moment for compliance control (a horizontal component and 
a vertical component), a horizontal body acceleration, a 
body posture Inclination angular acceleration, and an 
10 antiphase arm swing angular acceleration are determined 
such that the conditions of the floor reaction force 
moment horizontal component permissible range, the floor 
reaction force moment vertical component permissible range, 
and the floor reaction force horizontal component 
15 permissible range are satisfied, as in S2114 of Fig. 61. 

Subsequently, the processing proceeds from S5126 to 
S5128 to carry out the same processing as that of S2116 to 
S2118 of Fig. 61. 

The corrected gait instantaneous value determining 
20 subroutine is implemented as described above. Then, the 
processing proceeds to S2336 of Fig. 77 wherein current 
time t is incremented by At, and returns to S2314 again to 
continue generating gaits. 

The above is the processing of the gait generating 
25 device 100 in the present embodiment. 

As described above, in the present embodiment, the 
floor reaction force horizontal component permissible 
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range and the floor reaction force moment vertical 
component permissible range are changed according to a 
slippage determination result. Alternatively^ however, 
only one of the floor reaction force horizontal component 
5 permissible range and the floor reaction force moment 
vertical component permissible range may be changed. 

Generally, if the foot 22 slips parallel on a floor 
surface (If It slips In a shearing direction), then the 
gripping force In a spin direction (yaw direction) 

10 accordingly decreases. Conversely, if the foot 22 slips 
in the spin direction (yaw direction) , then the foot 22 
easily slips parallel on the floor surface. Hence, 
narrowing (setting to zero) both the floor reaction force 
horizontal component permissible range and the floor 

15 reaction force moment vertical component permissible range 
when either slippage is detected will achieve more 
effective recovery from the slippage. 

The first embodiment explained above provides the 
embodiments of the third to the seventh inventions of the 

20 present invention. In this case, the floor reaction force 
horizontal component in the first embodiment corresponds 
to a restriction object amount, and the body posture 
Inclination angle error and/or the body posture 
inclination angular velocity error corresponds to an error 

25 of the status eunount of the robot 1. A floor reaction 
force horizontal component permissible range [Fxmin, 
Fxmax] for generating gaits in the first embodiment 
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corresponds to the permissible range of a restriction 
object amount. The dynamic models In the Invention 
correspond to the dyneunlc model shown In Fig. 12. The 
motion component and the floor reaction force component of 
5 the corrected gait Instantaneous values determined in 

S2334 of Fig. 77 correspond to the Instantaneous value of 
a desired motion and the Instantaneous value of a desired 
floor reaction force, respectively. 

10 The gait generating device 100 in the aforementioned 

first embodiment has used the one In the aforementioned 
third reference example; however. It may use any one in 
the first, the second or the fourth to the seventh 
reference examples Instead of the one in the third 

15 reference example. 

In an embodiment using the first reference example, 
to determine the instantaneous value of a current time 
gait in, for example, S030 of Fig. 13, the processing from 
S5116 to S5122 of Fig. 78 may be Inserted between S1411 

20 and S1412 of Fig. 45, which shows the subroutine thereof. 
Such an embodiment (the second embodiment) provides the 
embodiments of the first Invention, the second invention, 
and the fifth to the seventh Inventions of the present 
Invention. In this case, the floor reaction force 

25 horizontal component in the first embodiment corresponds 
to a restriction object amount in the first invention, 
while the floor reaction force vertical component 
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corresponds to the restriction object amount In the second 
Invention. Further, the floor reaction force horizontal 
component permissible range [Fxmln, Fxmax] for gait 
generation In the first embodiment corresponds to the 
5 permissible range of the restriction object amount In the 
first Invention, while the floor reaction force moment 
vertical component pesnnlsslble range [Mzmln, Mzmax] for 
gait generation corresponds to the permissible range of 
the restriction object amount In the second Invention. 

10 The dynamic model shovm In Fig. 12 corresponds to the 

dynamic models In the Invention. The motional component 
of the current time gait Instantaneous value determined In 
S030 of Fig. 13 corresponds to a desired motion. In S1004 
of Fig. 46 executed In S030 of Fig. 13, the motion 

15 provisionally determined In S504 and S518 (refer to Fig. 
26) corresponds to the provisional motion In the first 
Invention or the second Invention described above. 

Further, In the embodiment using the second reference 
example, to determine the Instantaneous value of a current 

20 time gait In, for example, S03032 of Fig. 56, the 

processing from S5116 to S5122 of Fig. 78 may be Inserted 
between S3411 and S3412 of Fig. 57, which shows the 
subroutine thereof. Such an embodiment (the third 
embodiment) provides the embodiments of the third to the 

25 seventh Inventions In the present Invention. In this case, 
the floor reaction force horizontal component In the third 
embodiment corresponds to a restriction object amount. 
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while the body posture Inclination angle error and/or the 
body posture Inclination angular velocity error 
corresponds to the error of the state amount of the robot 
1 In the third and the fourth Inventions. Further, the 
5 floor reaction force horizontal component permissible 
range [Fxmln, Fxmax] for gait generation In the third 
embodiment corresponds to the permissible range of the 
restriction object amount. The dynamic model shown In Fig. 
12 corresponds to the dynamic models In the Invention. 

10 The motional component and the floor reaction force 

component of the current time gait Instantaneous values 
determined In S3034 of Fig. 56 correspond to the 
Instantaneous value of a desired motion and the 
Instantaneous value of a desired floor reaction force. In 

15 the third embodiment, the floor reaction force moment 

vertical component compensation amount permissible range 
may be variably set according to a slippage occurrence 
determination result. 

In an embodiment using the fourth reference exeunple, 

20 to execute, for example, the processing of S3536 of Fig. 

65 (the gait correction processing based on a full model) , 
the processing of S5116 to S5122 of Fig. 78 may be 
executed to variably set a permissible range. Such an 
embodiment (the fourth embodiment) provides the 

25 embodiments of the third to the seventh Inventions In the 
present invention. In this case, the floor reaction force 
horizontal component In the fourth embodiment corresponds 
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to a restriction object amount, and the body posture 
inclination angle error and/or the body posture 
inclination angular velocity error corresponds to the 
error of the state amount of the robot 1. Further, the 
5 floor reaction force horizontal component permissible 
range [Fxmin, Fxmax] for gait generation in the fourth 
embodiment corresponds to the permissible range of the 
restriction object amount. The motional component and the 
floor reaction force component of the gait corrected in 

10 S3536 of Fig. 65 correspond to the instantaneous value of 
a desired motion and the instantaneous value of a desired 
floor reaction force, respectively, in the third invention 
and the fourth invention. The inverse full models 
(including the perturbation models 202, 203 and 231) 

15 correspond to the dyneunic models in the invention. 

In an embodiment using the fifth reference example, 
to execute, for example, the processing of S3536 of Fig. 
65 (the gait correction processing based on a full model), 
the processing of S5116 to S5122 of Fig. 78 may be 

20 executed to variably set a permissible range. Such an 

embodiment (the fifth embodiment) provides the embodiments 
of the third to the seventh inventions in the present 
invention. In this case, the floor reaction force 
horizontal component in the fifth emboddLment corresponds 

25 to a restriction object amount, and the body posture 
inclination angle error and/or the body posture 
inclination angular velocity error corresponds to the 
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error of the state eunount of the robot 1. Further, the 
floor reaction force horizontal component permissible 
range [Fxmin, Fxmax] for gait generation in the fifth 
embodiment corresponds to the permissible range of the 
5 restriction object amount. The motional component and the 
floor reaction force component of the gait corrected in 
S3536 of Fig. 65 correspond to the instantaneous value of 
a desired motion and the instantaneous value of a desired 
floor reaction force, respectively, in the third invention 

10 and the fourth invention. The full models (including the 
perturbation models 202, 203 and 231) correspond to the 
dynamic models in the invention. 

The embodiments using the sixth and the seventh 
reference examples are similar to the aforesaid fifth 

15 embodiment, and provide the embodiments of the third to 
the seventh inventions. 

As the method for determining slippages, any one of 
the following may be used in place of the methods 

20 described in the aforementioned first embodiment. 

Alternatively, these results may be comprehensively 
determined (using logical operations, including logical 
sums and products). 

1) The angular velocity of the foot 22 with respect 

25 to a floor is determined using an angular velocity 

detector or the like, and if the absolute value of this 
value exceeds a predetermined value, then it is determined 
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that a slippage has occurred. 

2) If the absolute value of a floor reaction force 
moment of either leg 2 exceeds a predetermined value, then 
it is determined that a slippage has occurred. 
5 3) If the absolute value of a total floor reaction 

force moment (the moment of the resulting force of the 
floor reaction forces of both legs 2 and 2) exceeds a 
predetermined value, then it is determined that a slippage 
has occurred . 

10 4) In a double stance period, if the value obtained 

by multiplying the ratio of the changing rate of a total 
floor reaction force moment to a body posture angular 
velocity error by (-1) is smaller than a predetermined 
value (the torsional rigidity when both legs are in 

15 contact with the ground) , then it is determined that a 
slippage has occurred. 

5) If the absolute values of detections values 
(estimated values) of a non-contact type ground velocity 
or angular velocity detector using a visual sensor, a 

20 spatial filter or the like, or of a contact-type ground 
velocity or angular velocity detector exceed a 
predetermined value, then it is determined that a slippage 
has occurred. 

25 Modifications according to the aforementioned first 

to seventh reference examples and embodiments using them 
(including the aforementioned first to fifth embodiments) 
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will now be explained. 

In the aforesaid second to seventh reference examples 
and the embodiments using them, the compensating total 
floor reaction force moment horizontal component and the 
5 compensating total floor reaction force moment vertical 
component have been determined; alternatively, however, 
one or both of the compensating total floor reaction force 
moment horizontal component and the compensating total 
floor reaction force moment vertical component may be set 

10 to zero. In this case, however, full model correction Is 
used merely to enhance the accuracy of a desired gait 
based on a simplified model, and the body posture 
Inclination restoring effect and/or the body yaw angle 
(angular velocity) restoring effect obtainable by 

15 correcting gaits by a full model Is no longer provided. 

In the aforementioned fourth to seventh reference 
excimples and the embodiments using them, the generation of 
gaits by the simplified model 200 (the simplified model 
gait generation) may be performed using the gait 

20 generating devices according to the first embodiment and 
the second embodiment In the Japanese Unexamined Patent 
Application Publication No. 5-337849 previously proposed 
by the present applicant. The correction amount by a full 
model can be reduced, making It possible to prevent a 

25 corrected gait from significantly deviating from a 
simplified model gait. 

In the aforesaid second reference example and the 
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embodiments using It, If the compensating total floor 
reaction force moment horizontal component Mdmdxy exceeds 
a floor reaction force moment permissible range horizontal 
component (In the fourth reference example and after and 
5 the embodiments using them. If the sum of the compensating 
total floor reaction force moment horizontal component 
Mdmdxy and a model manipulation floor reaction force 
moment horizontal component exceeds a floor reaction force 
moment permissible range), then a desired floor reaction 

10 force moment horizontal component for compliance control 
takes an upper limit value or a lower limit value of the 
floor reaction force moment horizontal component 
permissible range. Alternatively, however, the desired 
floor reaction force moment horizontal component for 

15 compliance control may be Increased or decreased as the 

compensating total floor reaction force moment horizontal 
component Mdmdxy (In the fourth reference example and 
after and the embodiments using them, the sum of the 
compensating total floor reaction force moment horizontal 

20 component Mdmdxy and the model manipulation floor reaction 
force moment horizontal component) Increases or decreases 
even If the compensating total floor reaction force moment 
horizontal component Mdmdxy (In the fourth reference 
example and after and the embodiments using them, the sum 

25 of the compensating total floor reaction force moment 
horizontal component Mdmdxy and the model manipulation 
floor reaction force moment horizontal component) exceeds 
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the floor reaction force moment horizontal component 
permissible range. This Is because, as the desired floor 
reaction force moment horizontal component for compliance 
control approximates a floor reaction force moment 
5 horizontal component permissible range, an actual floor 
reaction force moment horizontal component controlled by 
the compliance control tends to be smaller than the 
desired value, and therefore, even If the desired floor 
reaction force moment horizontal component for compliance 
10 control slightly exceeds a permissible range. It Is vejry 
likely that this does not Immediately cause a problem, 
such as a deteriorated Intrinsic ground contacting 
property of the foot 22 or floating of the sole of the 
foot 22. 

15 For the same reason, the floor reaction force moment 

horizontal component permissible range may be set, 
exceeding a permissible range obtained by converting the 
range. In which ZMP can exist and which Is represented by 
a so-called supporting polygon (In a strict expression, 

20 the permissible range In which actual floor reaction force 
points of action exist). Into moment horizontal components. 

Undue dependence on the floor reaction force moment 
horizontal component produced by compliance control causes 
a problem, such as a deteriorated Intrinsic ground 

25 contacting property of the foot 22 or floating of the sole 
of the foot 22, as described above. Hence, the floor 
reaction force moment horizontal component permissible 
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range may be said to be the permissible range of actual 
floor reaction force moment horizontal components that 
posture control expects of the compliance control. 

The floor reaction force moment horizontal component 
5 permissible range may alternatively be determined on the 

basis of also detected actual floor reaction forces rather 
than only on the basis of gait parameters. Further, It 
may be also determined on the basis of detection values of 
ground contact regions of the foot 22, such as edge 

10 position detection values on stairs. 

Meanwhile, undue dependence on the floor reaction 
force moment vertical component produced by compliance 
control causes a problem, such as spinning. Hence, the 
floor reaction force moment vertical component permissible 

15 range may be said to be the permissible range of actual 
floor reaction force moment vertical components that 
posture control expects of the compliance control. 

The processing of the main flowchart may be changed 
so as to implement the correction of a current time gait 

20 parameter (the correction of a desired ZMP) in S3028 of 

Fig. 56 of the aforesaid second reference example and the 
embodiments, which use the second reference example, for 
each control cycle. 

If a corrected gait (desired gait) considerably 

25 deviates (diverges) from an original gait, it will have 
excessively deviated (excessively diverged) by the time 
the gait parameter correction of the next gait is 
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implemented, making it difficult to generate a desired 
gait that continuously remains stable for a long period 
simply by correcting gait parameters of the next gait. 
This problem can be solved to a great extent by correcting 
5 the current time gait parameter (by correcting a desired 
ZMP) for each control cycle. 

Furthermore, depending on deviation from an original 
gait, a foot landing position or landing time of the 
current time gait may be changed for each control cycle. 

10 Specifically, the processing flow is changed 

beforehand so as to carry out the processing from S3020 to 
S3 030 for each control cycle, and then in S3020, at least 
one of the next time's gait supporting leg coordinate 
system (the next time's gait supporting leg coordinate 

15 system corresponding to the next foot landing 

position/posture), the next but one time's gait supporting 
leg coordinate system (the next but one time's gait 
supporting leg coordinate system corresponding to the next 
but one time foot landing position/posture), the current 

20 time gait cycle (the current time gait cycle corresponding 
to the next foot landing time) , and the next time gait 
cycle (the next time gait cycle corresponding to the cycle 
of normal gait) is changed as necessary to reduce the 
correction of the current time gait parameter in S3028 

25 (the correction of the desired ZMP in particular ) (that is, 
to maintain a high stability allowance of the current time 
gait) . 
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Furthermore, different gait parameters from those 
mentioned above may be changed. 

The deviation of a corrected gait from an original 
gait can be estimated, using a dyneunic model, primarily 
5 from a simplified model body posture inclination angle 

correcting moment Mr, a simplified model horizontal body 
position correcting moment Mp, and a simplified model 
antiphase arm swing angle correcting moment Ma. Hence, 
based on Mr, Mp and Ma, model behavior deviations may be 
10 estimated and gait parameters may be corrected on the 

basis of the estimated behavior deviations. Alternatively, 
the relationship between Mr, Mp and Ma and the proper 
values of gait parameter correction amounts may be 
determined beforehand and mapped so as to determine the 
15 correction amounts of gait parameters according to the map 
on the basis of Mr, Mp and Ma. 

The processing flow may be changed also for other 
embodiments (the embodiments using the fourth to the 
seventh reference examples) in the same manner as 
20 described above. 

In addition to the aforementioned conditions, other 
kinematic conditions and dynamic conditions, e.g., whether 
joint angles exceed a permissible range, whether legs or 
the like are interfering, or whether a joint angular 
25 velocity or torque is too high, may be added to the 
restoring conditions . 

Accordingly, the following may be added as one of the 
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restoring conditions: If the processing of a main 
flowchart has been changed so as to Implement the 
correction of a current time gait parameters (the 
correction of a desired ZMP or a landing position, time or 
5 the like) for each control cycle as described above, then 
the value of the gait parameter, which is changed as 
necessary to maintain a high stability allowance of a 
current gait. Is set to a proper value (to satisfy a 
certain restrictive condition). 

10 The landing position and the landing time determined 

(read In) at a gait switching point are determined In 
response to an Instruction from a higher control unit 
(mainly an Instruction from a walking scheme determiner or 
from an operator. This is referred to as an original 

15 request). Thus, the landing position and the landing time 
of a corrected gait should be returned to the landing 
position and the landing time determined (read in) at the 
gait switching point as much as possible. For this reason, 
the landing position and the landing time determined (read 

20 in) at the gait switching point may be stored, and the 

landing position and the landing time of a corrected gait 
may be matched to or approximated to the stored landing 
position and landing time as much as possible. This may 
be added to the restoring conditions. Actually, however, 

25 the landing position and the landing time of a corrected 
gait are arranged so as to gradually return, as much as 
possible, to the landing position and the landing time 
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determined (read In) at a gait switching point by the 
aforementioned restoring conditions 4, 5 and 6; therefore, 
it is not essential to add the above additional condition. 
Another condition, in which an original request is 
5 changed in response to a change in a situation and the 
gait parameter changed as necessary to maintain a high 
stability allowance of a gait as described above is 
matched with or approximated to, as much as possible, a 
gait pareimeter that satisfies the changed request, may be 
10 added to the restoring conditions. In this case, the 

aforementioned restoring conditions 4, 5 and 6 should be 
deleted. 

As the method for determining a model horizontal body 
position stabilization floor reaction force moment and a 

15 model body posture inclination angle stabilization floor 
reaction force moment that satisfy the various restoring 
conditions described above, a linear programming (e.g., 
simplex method) or a retrieval method for determining 
optimum values under restrictive conditions may be used. 

20 Alternatively, a fuzzy inference may be used. 

When changing a landing position, a situation wherein 
obstacles in a walking environment or the like have to be 
taken into account is conceivable. To make it possible to 
cope with such a situation, a corrected gait should be 

25 determined by also adding the processing that belongs to 
the field of artificial intelligence, such as recognition 
of environments and determination of actions. 
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The same applies to the method for determining a 
model antiphase arm swing angle stabilization floor 
reaction force moment . 

The block diagrams before and after the limiting 
5 means (the restriction processing unit) In the 

aforementioned fourth to sixth reference examples and the 
embodiments using them may be subjected to equivalent 
conversion or approximate conversion as shown In, for 
example, PCT/ JP02/13593 by the present applicant. 

10 In this case, the value obtained by subtracting the 

value, which Is acquired by passing the value of a 
horizontal body position correcting model stabilization 
moment Mpf that has been divided by h through a low-pass 
filter, from a corrected desired floor reaction force 

15 horizontal component (a full-model floor reaction force 
horizontal component Ffull) corresponds to a biased 
estimated value destm In the above PCT application. Hence, 
for example, the integration of the gain Kc in the 
aforementioned fifth to seventh reference examples and the 

20 embodiments using them may be replaced into a positive 
feedback system having the first -order lag of a time 
constant 1/Kc as a feedback element to perform the 
approximate conversion as shown in Fig. 84. In this 
example, the Mpf calculator 215 in the fifth to the 

25 seventh reference examples and the embodiments using them 
is subjected to the approximate conversion as illustrated 
in the figure. 
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The antiphase arm swing angle correcting perturbation 
model moment may be also determined by Implementing the 
equivalent conversion or approximate conversion In the 
same manner. 

5 In the aforementioned fourth reference example and 

the embodiments using It, for the aforesaid antiphase arm 
swing angle correcting perturbation model moment, the 
processing of the functional block diagram shown In Fig. 
85 may be carried out In place of the functional block 

10 diagram shown In Fig. 70. This will be explained below. 
In Fig. 70, the behavior of an antiphase arm swing angle 
correcting model has been decided by determining whether a 
floor reaction force moment vertical component. Including 
the moment vertical component generated by a motion of 

15 restoration by an antiphase arm swing angle correcting 
model, exceeds a floor reaction force moment vertical 
component permissible range. In the processing of the 
functional block diagram shown In Fig. 85, the moment 
vertical component generated by the motion of restoration 

20 by an antiphase arm swing angle correcting model Is 

Ignored In determining whether the floor reaction force 
moment permissible range Is exceeded. 

The processing of the functional block diagram shown 
In Fig. 85 will be explained In detail. The sum of a 

25 full-model floor reaction force moment vertical component 
Mfullz, a floor reaction force moment vertical component 
perturbation amount Mpz attributable to the correction of 
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a horizontal body position, and a compensating total floor 
reaction force moment vertical component Mdmdz Is defined 
as a corrected desired floor reaction force moment 
vertical component without restriction Mlnz, and a 
restriction Is added thereto In the same manner as that 
shown in Fig. 70 to determine a corrected desired floor 
reaction force moment vertical component with restriction 
Mltdz. The corrected desired floor reaction force moment 
vertical component with restriction Mltdz is output as a 
desired floor reaction force moment vertical component for 
compliance control. Furthermore, the value obtained by 
subtracting the corrected desired floor reaction force 
moment vertical component without restriction Mlnz from 
the corrected desired floor reaction force moment vertical 
component with restriction Mltdz, i.e., a portion Maa, 
which is the portion of the corrected desired floor 
reaction force moment vertical component without 
restriction Mlnz that exceeds the floor reaction force 
moment vertical component permissible range, is determined. 
Then, based on the last time value of a correcting 
perturbation model antiphase arm swing angle Oca, a 
required value Mafdmd of antiphase arm swing angle 
correcting model stabilization moment is determined 
according to an antiphase arm swing angle correcting 
perturbation model control law using PD control or the 
like, and the value (moment) obtained by subtracting the 
determined value from Maa is supplied to an antiphase arm 
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swing angle correcting perturbation model to acquire the 
correcting perturbation model antiphase arm swing angle 
Oca. 

A transfer function from Maa to the correcting 
5 perturbation model antiphase arm swing angle Oca provides 
the transfer function of a low-pass filter. 

In other words, a floor reaction force moment 
vertical component (a floor reaction force moment vertical 
component without restriction) generated when the floor 

10 reaction force moment vertical component based on the 

antiphase arm swing angle correcting model is not canceled 
(excess preventing operation is not performed) Is passed 
through a restricting means (saturating means) that 
restricts it so as not to exceed the floor reaction force 

15 moment vertical component permissible range, thereby 

obtaining a desired floor reaction force moment vertical 
component for compliance control (a corrected desired 
floor reaction force moment vertical component with 
restriction Mltdz). In addition, the value obtained by 

20 passing the floor reaction force moment vertical component 
without restriction through a dead- zone means for 
determining the portion exceeding the floor reaction force 
moment vertical component permissible range is passed 
through a low-pass filter (i.e., a high-cut filter) to 

25 acquire the correcting perturbation model antiphase arm 
swing angle Oca. 

According to the aforementioned first and second 
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reference examples and the embodiments using them. In 
addition to the construction described In Japanese 
Unexamined Patent Application Publication 5-337849 
proposed by the present applicant, the behaviors of two 
5 motion modes having different generating ratios of a floor 
reaction force horizontal component and the floor reaction 
force moment horizontal component about a desired ZMP, 
e.g., the body translatlonal acceleration of the body 
translatlonal motion mode and the body posture Inclination 

10 angular acceleration of the body Inclination motion mode, 
are determined such that the translatlonal force 
horizontal component of a floor reaction force does not 
exceed the permissible range of floor reaction force 
horizontal component, thus allowing the actual robot 1 to 

15 converge to a corrected desired gait (the gait lastly 

output from the gait generating device 100). This means 
that the posture of the actual robot 1 can be stabilized. 

The difference between a desired floor reaction force 
moment horizontal component for compliance control and a 

20 model manipulation floor reaction force moment horizontal 
component provides a total restoring force. 

The model manipulation floor reaction force moment 
horizontal component can take any value. Ignoring the 
range In which a ZMP can exist, so that It Is possible to 

25 generate an extremely high posture restoring force. 

The translatlonal force horizontal component of a 
floor reaction force does not exceed the permissible range 
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of floor reaction force horizontal component, making It 
possible to prevent slippages of the robot 1. 

A floor reaction force moment vertical component (a 
desired floor reaction force moment vertical component for 
5 compliance control) and eventually an actual floor 

reaction force moment vertical component do not exceed the 
permissible range of floor reaction force moment vertical 
component, making It possible to further effect prevention 
of slippages of the robot 1. 

10 During a period in which a floor reaction force 

vertical component Is zero, that Is, during a period In 
which neither of both legs 2 and 2 Is In contact with the 
ground, posture restoration depending on a body rotation 
motion mode Is carried out without depending on the body 

15 translatlonal motion mode, so that the posture restoration 
Is effectively Implemented without dependence on the 
frlctional force between a floor and the foot 22. 

An actual floor reaction force moment can be 
prevented from unduly Increasing, thus making It possible 

20 to prevent or restrain the occurrence of a problem, such 
as deteriorated Intrinsic ground contacting property of 
the foot 22 or the sole of the foot 22 floating. 

A current time gait parameter Is determined or 
changed such that a new current time gait using the 

25 terminal state of a corrected gait for one step as its 

Initial state gradually approximates a normal gait, thus 
making it possible to continue generating gaits with 



- 406 - 



continuously (long-term) ensured stability. 

In the aforementioned third reference example and the 
aforementioned first embodiment using the third reference 
example, as described above, an original gait and a 
5 corrected gait are simultaneously generated, and the 

corrected gait is corrected to stabilize the posture of 
the actual robot 1. In addition, if there is still an 
allowance after generating the floor reaction force moment 
(a horizontal component and a vertical component) 

10 necessary for posture restoration by compliance control, 
then this allowance is used to converge to the original 
gait within a possible range. Hence, in addition to the 
advantages of the second reference example, it is possible 
to generate a gait that is close to the original gait 

15 initially set, i.e., the gait as per an initial request. 
Thus, if there is a preset travel path, significant 
deviation from the travel path can be prevented. 
Furthermore, a priority is given to the convergence of the 
body posture angle of a corrected gait to the body posture 

20 angle of the original gait (originally determined gait) 
rather than to the convergence of the horizontal body 
position of a corrected gait to the horizontal body 
position of the original gait (originally determined gait), 
making it possible to restrain a body posture angle from 

25 considerably varying. 

In the aforementioned first to seventh reference 
examples and the embodiments using them, the floor 
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reaction force horizontal component permissible range has 
been set. Alternatively, however, since a floor reaction 
force horizontal component and the total center- of -gravity 
horizontal acceleration of the robot are In a proportional 
5 relationship, the total center- of- gravity horizontal 

acceleration of the robot and Its permissible range may be 
used In place of the floor reaction force horizontal 
component and Its permissible range In each of the 
aforesaid embodiments. Furthermore, a parameter related 

10 to the horizontal acceleration trajectory of a part having 
a behavior close to a total center- of -gravity horizontal 
trajectory of the robot may be explicitly set. For 
Instance, If the mass of the legs 2 and 2 Is sufficiently 
smaller than the mass of the body 3, then the horizontal 

15 body acceleration trajectory and the total center-of- 

gravlty horizontal acceleration trajectory of the robot 1 
are substantially Identical or In a proportional 
relationship. Therefore, the horizontal body acceleration 
and Its permissible range may be used In place of a floor 

20 reaction force horizontal component and Its permissible 
range • 

Moreover, when generating gaits for traveling on a 
slope (when moving the robot 1 on an Inclined floor 
surface), the permissible range of the floor surface 
25 parallel component (the component parallel to the floor 

surface) of a translatlonal floor reaction force, that Is, 
a frlctlonal force, or the permissible range of the floor 
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surface parallel component of a total center-of -gravity 
acceleration (this is proportional to a frictional force, 
provided a gravity component is excluded) may be set in 
place of the floor reaction force horizontal component 
5 permissible range or the permissible range of total 

center-of -gravity acceleration horizontal component. An 
explanation of, for example, a case where the permissible 
range of a floor surface parallel component (frictional 
force) of a translational floor reaction force is set will 

10 be given (this explanation applies also to the case where 
the permissible range of the floor surface parallel 
component of a total center-of -gravity acceleration is 
set). For the frictional force, the relationship of 
Equation c72 given below holds when the inclination angle 

15 with respect to the horizontal plane of the floor surface 
is denoted by Of (defined as positive for a slope 
inclining forward in the direction in which the robot 1 
advances). Hence, to generate a gait according to the 
algorithm similar to that in the aforementioned embodiment, 

20 a frictional force permissible range may be converted into 
a floor reaction force horizontal component permissible 
range by using the relationship of the Equation c72 so as 
to set the floor reaction force horizontal component 
permissible range. In this case, a desired floor reaction 

25 force vertical component may be used as the floor reaction 
force vertical component in Equation c72. 
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Frictlonal force = Floor reaction force horizontal 
component * cos (Of) - Floor reaction force vertical 
component * slnCBf) ... Equation c72 

5 In generating a gait for traveling on a slope (when 

moving the robot 1 on an Inclined floor surface), the 
permissible range of the component in the direction of 
floor surface normal line of a floor reaction force moment, 
i.e,, a frictlonal force moment, may be set in place of a 

10 floor reaction force moment vertical component permissible 
range. For exeunple, the relationship of Equation c73 
given below holds for the frictlonal force moment when the 
Inclination angle with respect to the horizontal plane of 
the floor surface is denoted by 8f (defined as positive 

15 for a slope inclining forward in the direction in which 
the robot 1 advances ) • Hence , to generate a gait 
according to the algorithm similar to that in the 
aforementioned embodiments, this relationship of Equation 
c73 may be used to calculate the frictlonal force moment 

20 from a floor reaction force moment vertical component and 
a floor reaction force moment horizontal component, and 
then the processing may be changed so that this value does 
not exceed the permissible range of the frictlonal force 
moment . 

25 

Frictlonal force moment = Floor reaction force moment 
vertical component * cos(6f ) + Floor reaction force moment 



- 410 - 



horizontal component ♦ sln(8f ) 

... Equation c73 

As explained In the modification related to the 
5 aforementioned first reference example, the two motion 
modes, namely, the body inclination mode and the body 
translatlonal mode, have been used In the aforementioned 
embodiments to set the floor reaction force horizontal 
component and the floor reaction force moment horizontal 

10 component about a desired ZMP to proper values; however, 

different motion modes from them may alternatively be used. 
In this case. It Is not required that one of the motion 
modes be a motion mode that does not generate a floor 
reaction force horizontal component. This Is because, 

15 arbitrary floor reaction force horizontal component and 
floor reaction force moment about a desired ZMP can be 
generated as In the above example by any combination of 
modes as long as two motion modes that generate a floor 
reaction force horizontal component and a floor reaction 

20 force moment about a desired ZMP at different ratios are 
used. 

Furthermore, a motion mode other than a body posture 
may be used. However, a motion mode should be selected 
that permits generation of a large floor reaction force 
25 horizontal component or a large floor reaction force 

moment about a desired ZMP with a minimum of displacement 
as much as possible. 
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For Instance, a motion mode for swinging right and 
left arms in the same rotational direction or a motion for 
perturbating the position of a foot not in contact with 
the ground (floating) may be selected. However, if a free 
5 leg trajectory is to be perturbated, the perturbation 

cimount should be reset virtually to zero by immediately 
before landing so as not to disturb a landing position. 

Alternatively, three or more motion modes may be used. 

The generating ratios of a floor reaction force 
10 horizontal component and a floor reaction force moment 

about a desired ZMP of at least two of selected modes must 
be different from each other. Otherwise, no solution of a 
simultaneous equation will be usually obtained. 

In addition, it is desirable to combine, as much as 
15 possible, a motion mode that allows a sufficiently large 
change to take place in the floor reaction force moment 
about a desired ZMP without changing a floor reaction 
force horizontal component much, and a motion mode that 
allows a sufficiently large change to take place in the 
20 floor reaction force horizontal component without changing 
a floor reaction force moment about a desired ZMP much. 

In other words, it is desirable to combine a motion 
mode that allows a sufficiently large change to take place 
in an angular momentum without changing a total center of 
25 gravity much and a motion mode that allows a sufficiently 
large change to take place in the total center of gravity 
without changing the angular momentum much. This is 
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because displacements In the motion modes will be smaller. 

In the aforementioned embodiments, the antiphase arm 
swing mode has been used to set the floor reaction force 
moment vertical component to a proper value; however, 
5 other motion modes may be used. For example, as explained 
about the modification of the aforementioned first 
reference example, the body yaw rotation mode may be used, 
or the body yaw rotation mode and the antiphase arm swing 
mode may be used in combination. 

10 Further, it is not required that the motion mode used 

to set the floor reaction force moment vertical component 
to a proper value be a motion mode that does not generate 
a floor reaction force horizontal component and a floor 
reaction force moment horizontal component. For Instance, 

15 a motion mode for swinging a free leg back and forth may 
be used. This is because the floor reaction force 
horizontal component and the floor reaction force moment 
horizontal component generated by the motion mode can be 
offset by adjusting the two motion modes, namely, the body 

20 inclination mode and the body translatlonal mode. 

In reference examples and embodiments using a full 
model, the following models besides the dynamic model (the 
model of Fig. 12) used in the aforementioned embodiments 
may be used as the aforementioned simplified models. 

25 1) A nonlinear model having mass points set on a 

plurality of links, as shown in Fig. 49 (multi-mass -point 
model ) 
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2) Three-mass -point model disclosed In PCT Kokai 
publication WO/02/40224 by the present applicant 

3) One -mass -point model having a mass only in the 

body 

5 4) Model that ignores the moment of the inertial 

force generated by a change in the angular momentum about 
a total center of gravity 

5) Separate type model that separately has a partial 
model representing the relationship between a resultant 

10 force of gravity and an inertial force (or a floor 

reaction force) and a body translational motion, and a 
partial model representing the relationship between the 
above resultant force and a body rotational motion. For 
instance, the mass points shown in Fig. 12 constitute a 

15 partial model indicating the relationship between the 

above resultant force and a body translational motion, and 
the flywheel shown in Fig. 12 is a partial model 
indicating the relationship between the above resultant 
force euid a body rotational motion. 

20 However, for a reference exeunple and an embodiment in 

which a simplified model body posture inclination angle 
correcting moment is added to a simplified model, the 
models of 2), 3) and 4) above cannot be used. 

Preferably, a full model basically uses a dynamic 

25 model having a higher approximation accuracy than that of 
a simplified model; however, a dynamic model having an 
approximation accuracy equivalent to that of a simplified 
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model may be used. 

Furthermore, in the embodiments described above, the 
block diagrams, the flowcharts, the algorithms and the 
like may be subjected to equivalent modifications, such as 
5 changing the order of calculation processing. In addition, 
low-pass filters may be Inserted, as necessary. 

The aforementioned embodiments have been explained In 
conjunction with bipedal mobile robots; however, the 
present Invention can be applied also to one-foot or 
10 multi-leg robots having three or more legs. 

Industrial Applicability 

As described above, the present Invention Is usefully 
applied for enabling a robot to maintain Its stable 
15 posture and smoothly travel, while restraining the 

occurrence of a slippage of the robot at the same time 
even In a circumstance In which the frlctlonal force 
between a legged mobile robot, such as a bipedal mobile 
robot, and a floor surface Is small. 



